xref: /openbmc/qemu/hw/scsi/megasas.c (revision 2b151297)
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"
3749ab747fSPaolo Bonzini 
38e23d0498SHannes Reinecke #define MEGASAS_VERSION_GEN1 "1.70"
39e23d0498SHannes Reinecke #define MEGASAS_VERSION_GEN2 "1.80"
4049ab747fSPaolo Bonzini #define MEGASAS_MAX_FRAMES 2048         /* Firmware limit at 65535 */
4149ab747fSPaolo Bonzini #define MEGASAS_DEFAULT_FRAMES 1000     /* Windows requires this */
42e23d0498SHannes Reinecke #define MEGASAS_GEN2_DEFAULT_FRAMES 1008     /* Windows requires this */
4349ab747fSPaolo Bonzini #define MEGASAS_MAX_SGE 128             /* Firmware limit */
4449ab747fSPaolo Bonzini #define MEGASAS_DEFAULT_SGE 80
4549ab747fSPaolo Bonzini #define MEGASAS_MAX_SECTORS 0xFFFF      /* No real limit */
4649ab747fSPaolo Bonzini #define MEGASAS_MAX_ARRAYS 128
4749ab747fSPaolo Bonzini 
4849ab747fSPaolo Bonzini #define MEGASAS_HBA_SERIAL "QEMU123456"
4949ab747fSPaolo Bonzini #define NAA_LOCALLY_ASSIGNED_ID 0x3ULL
5049ab747fSPaolo Bonzini #define IEEE_COMPANY_LOCALLY_ASSIGNED 0x525400
5149ab747fSPaolo Bonzini 
5249ab747fSPaolo Bonzini #define MEGASAS_FLAG_USE_JBOD      0
5349ab747fSPaolo Bonzini #define MEGASAS_MASK_USE_JBOD      (1 << MEGASAS_FLAG_USE_JBOD)
54b4b4a57fSCao jin #define MEGASAS_FLAG_USE_QUEUE64   1
5549ab747fSPaolo Bonzini #define MEGASAS_MASK_USE_QUEUE64   (1 << MEGASAS_FLAG_USE_QUEUE64)
5649ab747fSPaolo Bonzini 
5749ab747fSPaolo Bonzini static const char *mfi_frame_desc[] = {
5849ab747fSPaolo Bonzini     "MFI init", "LD Read", "LD Write", "LD SCSI", "PD SCSI",
5949ab747fSPaolo Bonzini     "MFI Doorbell", "MFI Abort", "MFI SMP", "MFI Stop"};
6049ab747fSPaolo Bonzini 
6149ab747fSPaolo Bonzini typedef struct MegasasCmd {
6249ab747fSPaolo Bonzini     uint32_t index;
6349ab747fSPaolo Bonzini     uint16_t flags;
6449ab747fSPaolo Bonzini     uint16_t count;
6549ab747fSPaolo Bonzini     uint64_t context;
6649ab747fSPaolo Bonzini 
6749ab747fSPaolo Bonzini     hwaddr pa;
6849ab747fSPaolo Bonzini     hwaddr pa_size;
695104fac8SPaolo Bonzini     uint32_t dcmd_opcode;
7049ab747fSPaolo Bonzini     union mfi_frame *frame;
7149ab747fSPaolo Bonzini     SCSIRequest *req;
7249ab747fSPaolo Bonzini     QEMUSGList qsg;
7349ab747fSPaolo Bonzini     void *iov_buf;
7449ab747fSPaolo Bonzini     size_t iov_size;
7549ab747fSPaolo Bonzini     size_t iov_offset;
7649ab747fSPaolo Bonzini     struct MegasasState *state;
7749ab747fSPaolo Bonzini } MegasasCmd;
7849ab747fSPaolo Bonzini 
7949ab747fSPaolo Bonzini typedef struct MegasasState {
8052190c1eSAndreas Färber     /*< private >*/
8152190c1eSAndreas Färber     PCIDevice parent_obj;
8252190c1eSAndreas Färber     /*< public >*/
8352190c1eSAndreas Färber 
8449ab747fSPaolo Bonzini     MemoryRegion mmio_io;
8549ab747fSPaolo Bonzini     MemoryRegion port_io;
8649ab747fSPaolo Bonzini     MemoryRegion queue_io;
8749ab747fSPaolo Bonzini     uint32_t frame_hi;
8849ab747fSPaolo Bonzini 
89*2b151297SPrasad J Pandit     uint32_t fw_state;
9049ab747fSPaolo Bonzini     uint32_t fw_sge;
9149ab747fSPaolo Bonzini     uint32_t fw_cmds;
9249ab747fSPaolo Bonzini     uint32_t flags;
93*2b151297SPrasad J Pandit     uint32_t fw_luns;
94*2b151297SPrasad J Pandit     uint32_t intr_mask;
95*2b151297SPrasad J Pandit     uint32_t doorbell;
96*2b151297SPrasad J Pandit     uint32_t busy;
97*2b151297SPrasad J Pandit     uint32_t diag;
98*2b151297SPrasad J Pandit     uint32_t adp_reset;
99b4b4a57fSCao jin     OnOffAuto msi;
100b4b4a57fSCao jin     OnOffAuto msix;
10149ab747fSPaolo Bonzini 
10249ab747fSPaolo Bonzini     MegasasCmd *event_cmd;
103*2b151297SPrasad J Pandit     uint16_t event_locale;
10449ab747fSPaolo Bonzini     int event_class;
105*2b151297SPrasad J Pandit     uint32_t event_count;
106*2b151297SPrasad J Pandit     uint32_t shutdown_event;
107*2b151297SPrasad J Pandit     uint32_t boot_event;
10849ab747fSPaolo Bonzini 
10949ab747fSPaolo Bonzini     uint64_t sas_addr;
11049ab747fSPaolo Bonzini     char *hba_serial;
11149ab747fSPaolo Bonzini 
11249ab747fSPaolo Bonzini     uint64_t reply_queue_pa;
11349ab747fSPaolo Bonzini     void *reply_queue;
114*2b151297SPrasad J Pandit     uint16_t reply_queue_len;
115f50ab86aSPrasad J Pandit     uint16_t reply_queue_head;
116*2b151297SPrasad J Pandit     uint16_t reply_queue_tail;
11749ab747fSPaolo Bonzini     uint64_t consumer_pa;
11849ab747fSPaolo Bonzini     uint64_t producer_pa;
11949ab747fSPaolo Bonzini 
12049ab747fSPaolo Bonzini     MegasasCmd frames[MEGASAS_MAX_FRAMES];
1216df5718bSHannes Reinecke     DECLARE_BITMAP(frame_map, MEGASAS_MAX_FRAMES);
12249ab747fSPaolo Bonzini     SCSIBus bus;
12349ab747fSPaolo Bonzini } MegasasState;
12449ab747fSPaolo Bonzini 
125e23d0498SHannes Reinecke typedef struct MegasasBaseClass {
126e23d0498SHannes Reinecke     PCIDeviceClass parent_class;
127e23d0498SHannes Reinecke     const char *product_name;
128e23d0498SHannes Reinecke     const char *product_version;
129e23d0498SHannes Reinecke     int mmio_bar;
130e23d0498SHannes Reinecke     int ioport_bar;
131e23d0498SHannes Reinecke     int osts;
132e23d0498SHannes Reinecke } MegasasBaseClass;
133e23d0498SHannes Reinecke 
134e23d0498SHannes Reinecke #define TYPE_MEGASAS_BASE "megasas-base"
135e23d0498SHannes Reinecke #define TYPE_MEGASAS_GEN1 "megasas"
136e23d0498SHannes Reinecke #define TYPE_MEGASAS_GEN2 "megasas-gen2"
137c79e16aeSPeter Crosthwaite 
138c79e16aeSPeter Crosthwaite #define MEGASAS(obj) \
139e23d0498SHannes Reinecke     OBJECT_CHECK(MegasasState, (obj), TYPE_MEGASAS_BASE)
140e23d0498SHannes Reinecke 
141e23d0498SHannes Reinecke #define MEGASAS_DEVICE_CLASS(oc) \
142e23d0498SHannes Reinecke     OBJECT_CLASS_CHECK(MegasasBaseClass, (oc), TYPE_MEGASAS_BASE)
143e23d0498SHannes Reinecke #define MEGASAS_DEVICE_GET_CLASS(oc) \
144e23d0498SHannes Reinecke     OBJECT_GET_CLASS(MegasasBaseClass, (oc), TYPE_MEGASAS_BASE)
145c79e16aeSPeter Crosthwaite 
14649ab747fSPaolo Bonzini #define MEGASAS_INTR_DISABLED_MASK 0xFFFFFFFF
14749ab747fSPaolo Bonzini 
14849ab747fSPaolo Bonzini static bool megasas_intr_enabled(MegasasState *s)
14949ab747fSPaolo Bonzini {
15049ab747fSPaolo Bonzini     if ((s->intr_mask & MEGASAS_INTR_DISABLED_MASK) !=
15149ab747fSPaolo Bonzini         MEGASAS_INTR_DISABLED_MASK) {
15249ab747fSPaolo Bonzini         return true;
15349ab747fSPaolo Bonzini     }
15449ab747fSPaolo Bonzini     return false;
15549ab747fSPaolo Bonzini }
15649ab747fSPaolo Bonzini 
15749ab747fSPaolo Bonzini static bool megasas_use_queue64(MegasasState *s)
15849ab747fSPaolo Bonzini {
15949ab747fSPaolo Bonzini     return s->flags & MEGASAS_MASK_USE_QUEUE64;
16049ab747fSPaolo Bonzini }
16149ab747fSPaolo Bonzini 
16249ab747fSPaolo Bonzini static bool megasas_use_msix(MegasasState *s)
16349ab747fSPaolo Bonzini {
164b4b4a57fSCao jin     return s->msix != ON_OFF_AUTO_OFF;
16549ab747fSPaolo Bonzini }
16649ab747fSPaolo Bonzini 
16749ab747fSPaolo Bonzini static bool megasas_is_jbod(MegasasState *s)
16849ab747fSPaolo Bonzini {
16949ab747fSPaolo Bonzini     return s->flags & MEGASAS_MASK_USE_JBOD;
17049ab747fSPaolo Bonzini }
17149ab747fSPaolo Bonzini 
17216578c6fSPaolo Bonzini static void megasas_frame_set_cmd_status(MegasasState *s,
17316578c6fSPaolo Bonzini                                          unsigned long frame, uint8_t v)
17449ab747fSPaolo Bonzini {
17516578c6fSPaolo Bonzini     PCIDevice *pci = &s->parent_obj;
17616578c6fSPaolo Bonzini     stb_pci_dma(pci, frame + offsetof(struct mfi_frame_header, cmd_status), v);
17749ab747fSPaolo Bonzini }
17849ab747fSPaolo Bonzini 
17916578c6fSPaolo Bonzini static void megasas_frame_set_scsi_status(MegasasState *s,
18016578c6fSPaolo Bonzini                                           unsigned long frame, uint8_t v)
18149ab747fSPaolo Bonzini {
18216578c6fSPaolo Bonzini     PCIDevice *pci = &s->parent_obj;
18316578c6fSPaolo Bonzini     stb_pci_dma(pci, frame + offsetof(struct mfi_frame_header, scsi_status), v);
18449ab747fSPaolo Bonzini }
18549ab747fSPaolo Bonzini 
18649ab747fSPaolo Bonzini /*
18749ab747fSPaolo Bonzini  * Context is considered opaque, but the HBA firmware is running
18849ab747fSPaolo Bonzini  * in little endian mode. So convert it to little endian, too.
18949ab747fSPaolo Bonzini  */
19016578c6fSPaolo Bonzini static uint64_t megasas_frame_get_context(MegasasState *s,
19116578c6fSPaolo Bonzini                                           unsigned long frame)
19249ab747fSPaolo Bonzini {
19316578c6fSPaolo Bonzini     PCIDevice *pci = &s->parent_obj;
19416578c6fSPaolo Bonzini     return ldq_le_pci_dma(pci, frame + offsetof(struct mfi_frame_header, context));
19549ab747fSPaolo Bonzini }
19649ab747fSPaolo Bonzini 
19749ab747fSPaolo Bonzini static bool megasas_frame_is_ieee_sgl(MegasasCmd *cmd)
19849ab747fSPaolo Bonzini {
19949ab747fSPaolo Bonzini     return cmd->flags & MFI_FRAME_IEEE_SGL;
20049ab747fSPaolo Bonzini }
20149ab747fSPaolo Bonzini 
20249ab747fSPaolo Bonzini static bool megasas_frame_is_sgl64(MegasasCmd *cmd)
20349ab747fSPaolo Bonzini {
20449ab747fSPaolo Bonzini     return cmd->flags & MFI_FRAME_SGL64;
20549ab747fSPaolo Bonzini }
20649ab747fSPaolo Bonzini 
20749ab747fSPaolo Bonzini static bool megasas_frame_is_sense64(MegasasCmd *cmd)
20849ab747fSPaolo Bonzini {
20949ab747fSPaolo Bonzini     return cmd->flags & MFI_FRAME_SENSE64;
21049ab747fSPaolo Bonzini }
21149ab747fSPaolo Bonzini 
21249ab747fSPaolo Bonzini static uint64_t megasas_sgl_get_addr(MegasasCmd *cmd,
21349ab747fSPaolo Bonzini                                      union mfi_sgl *sgl)
21449ab747fSPaolo Bonzini {
21549ab747fSPaolo Bonzini     uint64_t addr;
21649ab747fSPaolo Bonzini 
21749ab747fSPaolo Bonzini     if (megasas_frame_is_ieee_sgl(cmd)) {
21849ab747fSPaolo Bonzini         addr = le64_to_cpu(sgl->sg_skinny->addr);
21949ab747fSPaolo Bonzini     } else if (megasas_frame_is_sgl64(cmd)) {
22049ab747fSPaolo Bonzini         addr = le64_to_cpu(sgl->sg64->addr);
22149ab747fSPaolo Bonzini     } else {
22249ab747fSPaolo Bonzini         addr = le32_to_cpu(sgl->sg32->addr);
22349ab747fSPaolo Bonzini     }
22449ab747fSPaolo Bonzini     return addr;
22549ab747fSPaolo Bonzini }
22649ab747fSPaolo Bonzini 
22749ab747fSPaolo Bonzini static uint32_t megasas_sgl_get_len(MegasasCmd *cmd,
22849ab747fSPaolo Bonzini                                     union mfi_sgl *sgl)
22949ab747fSPaolo Bonzini {
23049ab747fSPaolo Bonzini     uint32_t len;
23149ab747fSPaolo Bonzini 
23249ab747fSPaolo Bonzini     if (megasas_frame_is_ieee_sgl(cmd)) {
23349ab747fSPaolo Bonzini         len = le32_to_cpu(sgl->sg_skinny->len);
23449ab747fSPaolo Bonzini     } else if (megasas_frame_is_sgl64(cmd)) {
23549ab747fSPaolo Bonzini         len = le32_to_cpu(sgl->sg64->len);
23649ab747fSPaolo Bonzini     } else {
23749ab747fSPaolo Bonzini         len = le32_to_cpu(sgl->sg32->len);
23849ab747fSPaolo Bonzini     }
23949ab747fSPaolo Bonzini     return len;
24049ab747fSPaolo Bonzini }
24149ab747fSPaolo Bonzini 
24249ab747fSPaolo Bonzini static union mfi_sgl *megasas_sgl_next(MegasasCmd *cmd,
24349ab747fSPaolo Bonzini                                        union mfi_sgl *sgl)
24449ab747fSPaolo Bonzini {
24549ab747fSPaolo Bonzini     uint8_t *next = (uint8_t *)sgl;
24649ab747fSPaolo Bonzini 
24749ab747fSPaolo Bonzini     if (megasas_frame_is_ieee_sgl(cmd)) {
24849ab747fSPaolo Bonzini         next += sizeof(struct mfi_sg_skinny);
24949ab747fSPaolo Bonzini     } else if (megasas_frame_is_sgl64(cmd)) {
25049ab747fSPaolo Bonzini         next += sizeof(struct mfi_sg64);
25149ab747fSPaolo Bonzini     } else {
25249ab747fSPaolo Bonzini         next += sizeof(struct mfi_sg32);
25349ab747fSPaolo Bonzini     }
25449ab747fSPaolo Bonzini 
25549ab747fSPaolo Bonzini     if (next >= (uint8_t *)cmd->frame + cmd->pa_size) {
25649ab747fSPaolo Bonzini         return NULL;
25749ab747fSPaolo Bonzini     }
25849ab747fSPaolo Bonzini     return (union mfi_sgl *)next;
25949ab747fSPaolo Bonzini }
26049ab747fSPaolo Bonzini 
26149ab747fSPaolo Bonzini static void megasas_soft_reset(MegasasState *s);
26249ab747fSPaolo Bonzini 
26349ab747fSPaolo Bonzini static int megasas_map_sgl(MegasasState *s, MegasasCmd *cmd, union mfi_sgl *sgl)
26449ab747fSPaolo Bonzini {
26549ab747fSPaolo Bonzini     int i;
26649ab747fSPaolo Bonzini     int iov_count = 0;
26749ab747fSPaolo Bonzini     size_t iov_size = 0;
26849ab747fSPaolo Bonzini 
26949ab747fSPaolo Bonzini     cmd->flags = le16_to_cpu(cmd->frame->header.flags);
27049ab747fSPaolo Bonzini     iov_count = cmd->frame->header.sge_count;
27149ab747fSPaolo Bonzini     if (iov_count > MEGASAS_MAX_SGE) {
27249ab747fSPaolo Bonzini         trace_megasas_iovec_sgl_overflow(cmd->index, iov_count,
27349ab747fSPaolo Bonzini                                          MEGASAS_MAX_SGE);
27449ab747fSPaolo Bonzini         return iov_count;
27549ab747fSPaolo Bonzini     }
27652190c1eSAndreas Färber     pci_dma_sglist_init(&cmd->qsg, PCI_DEVICE(s), iov_count);
27749ab747fSPaolo Bonzini     for (i = 0; i < iov_count; i++) {
27849ab747fSPaolo Bonzini         dma_addr_t iov_pa, iov_size_p;
27949ab747fSPaolo Bonzini 
28049ab747fSPaolo Bonzini         if (!sgl) {
28149ab747fSPaolo Bonzini             trace_megasas_iovec_sgl_underflow(cmd->index, i);
28249ab747fSPaolo Bonzini             goto unmap;
28349ab747fSPaolo Bonzini         }
28449ab747fSPaolo Bonzini         iov_pa = megasas_sgl_get_addr(cmd, sgl);
28549ab747fSPaolo Bonzini         iov_size_p = megasas_sgl_get_len(cmd, sgl);
28649ab747fSPaolo Bonzini         if (!iov_pa || !iov_size_p) {
28749ab747fSPaolo Bonzini             trace_megasas_iovec_sgl_invalid(cmd->index, i,
28849ab747fSPaolo Bonzini                                             iov_pa, iov_size_p);
28949ab747fSPaolo Bonzini             goto unmap;
29049ab747fSPaolo Bonzini         }
29149ab747fSPaolo Bonzini         qemu_sglist_add(&cmd->qsg, iov_pa, iov_size_p);
29249ab747fSPaolo Bonzini         sgl = megasas_sgl_next(cmd, sgl);
29349ab747fSPaolo Bonzini         iov_size += (size_t)iov_size_p;
29449ab747fSPaolo Bonzini     }
29549ab747fSPaolo Bonzini     if (cmd->iov_size > iov_size) {
29649ab747fSPaolo Bonzini         trace_megasas_iovec_overflow(cmd->index, iov_size, cmd->iov_size);
29749ab747fSPaolo Bonzini     } else if (cmd->iov_size < iov_size) {
298d17e7448SEric Blake         trace_megasas_iovec_underflow(cmd->index, iov_size, cmd->iov_size);
29949ab747fSPaolo Bonzini     }
30049ab747fSPaolo Bonzini     cmd->iov_offset = 0;
30149ab747fSPaolo Bonzini     return 0;
30249ab747fSPaolo Bonzini unmap:
30349ab747fSPaolo Bonzini     qemu_sglist_destroy(&cmd->qsg);
30449ab747fSPaolo Bonzini     return iov_count - i;
30549ab747fSPaolo Bonzini }
30649ab747fSPaolo Bonzini 
30749ab747fSPaolo Bonzini /*
30849ab747fSPaolo Bonzini  * passthrough sense and io sense are at the same offset
30949ab747fSPaolo Bonzini  */
31049ab747fSPaolo Bonzini static int megasas_build_sense(MegasasCmd *cmd, uint8_t *sense_ptr,
31149ab747fSPaolo Bonzini     uint8_t sense_len)
31249ab747fSPaolo Bonzini {
3131016b239SPaolo Bonzini     PCIDevice *pcid = PCI_DEVICE(cmd->state);
31449ab747fSPaolo Bonzini     uint32_t pa_hi = 0, pa_lo;
31549ab747fSPaolo Bonzini     hwaddr pa;
316134550bfSPaolo Bonzini     int frame_sense_len;
31749ab747fSPaolo Bonzini 
318134550bfSPaolo Bonzini     frame_sense_len = cmd->frame->header.sense_len;
319134550bfSPaolo Bonzini     if (sense_len > frame_sense_len) {
320134550bfSPaolo Bonzini         sense_len = frame_sense_len;
32149ab747fSPaolo Bonzini     }
32249ab747fSPaolo Bonzini     if (sense_len) {
32349ab747fSPaolo Bonzini         pa_lo = le32_to_cpu(cmd->frame->pass.sense_addr_lo);
32449ab747fSPaolo Bonzini         if (megasas_frame_is_sense64(cmd)) {
32549ab747fSPaolo Bonzini             pa_hi = le32_to_cpu(cmd->frame->pass.sense_addr_hi);
32649ab747fSPaolo Bonzini         }
32749ab747fSPaolo Bonzini         pa = ((uint64_t) pa_hi << 32) | pa_lo;
3281016b239SPaolo Bonzini         pci_dma_write(pcid, pa, sense_ptr, sense_len);
32949ab747fSPaolo Bonzini         cmd->frame->header.sense_len = sense_len;
33049ab747fSPaolo Bonzini     }
33149ab747fSPaolo Bonzini     return sense_len;
33249ab747fSPaolo Bonzini }
33349ab747fSPaolo Bonzini 
33449ab747fSPaolo Bonzini static void megasas_write_sense(MegasasCmd *cmd, SCSISense sense)
33549ab747fSPaolo Bonzini {
33649ab747fSPaolo Bonzini     uint8_t sense_buf[SCSI_SENSE_BUF_SIZE];
33749ab747fSPaolo Bonzini     uint8_t sense_len = 18;
33849ab747fSPaolo Bonzini 
33949ab747fSPaolo Bonzini     memset(sense_buf, 0, sense_len);
34049ab747fSPaolo Bonzini     sense_buf[0] = 0xf0;
34149ab747fSPaolo Bonzini     sense_buf[2] = sense.key;
34249ab747fSPaolo Bonzini     sense_buf[7] = 10;
34349ab747fSPaolo Bonzini     sense_buf[12] = sense.asc;
34449ab747fSPaolo Bonzini     sense_buf[13] = sense.ascq;
34549ab747fSPaolo Bonzini     megasas_build_sense(cmd, sense_buf, sense_len);
34649ab747fSPaolo Bonzini }
34749ab747fSPaolo Bonzini 
34849ab747fSPaolo Bonzini static void megasas_copy_sense(MegasasCmd *cmd)
34949ab747fSPaolo Bonzini {
35049ab747fSPaolo Bonzini     uint8_t sense_buf[SCSI_SENSE_BUF_SIZE];
35149ab747fSPaolo Bonzini     uint8_t sense_len;
35249ab747fSPaolo Bonzini 
35349ab747fSPaolo Bonzini     sense_len = scsi_req_get_sense(cmd->req, sense_buf,
35449ab747fSPaolo Bonzini                                    SCSI_SENSE_BUF_SIZE);
35549ab747fSPaolo Bonzini     megasas_build_sense(cmd, sense_buf, sense_len);
35649ab747fSPaolo Bonzini }
35749ab747fSPaolo Bonzini 
35849ab747fSPaolo Bonzini /*
35949ab747fSPaolo Bonzini  * Format an INQUIRY CDB
36049ab747fSPaolo Bonzini  */
36149ab747fSPaolo Bonzini static int megasas_setup_inquiry(uint8_t *cdb, int pg, int len)
36249ab747fSPaolo Bonzini {
36349ab747fSPaolo Bonzini     memset(cdb, 0, 6);
36449ab747fSPaolo Bonzini     cdb[0] = INQUIRY;
36549ab747fSPaolo Bonzini     if (pg > 0) {
36649ab747fSPaolo Bonzini         cdb[1] = 0x1;
36749ab747fSPaolo Bonzini         cdb[2] = pg;
36849ab747fSPaolo Bonzini     }
36949ab747fSPaolo Bonzini     cdb[3] = (len >> 8) & 0xff;
37049ab747fSPaolo Bonzini     cdb[4] = (len & 0xff);
37149ab747fSPaolo Bonzini     return len;
37249ab747fSPaolo Bonzini }
37349ab747fSPaolo Bonzini 
37449ab747fSPaolo Bonzini /*
37549ab747fSPaolo Bonzini  * Encode lba and len into a READ_16/WRITE_16 CDB
37649ab747fSPaolo Bonzini  */
37749ab747fSPaolo Bonzini static void megasas_encode_lba(uint8_t *cdb, uint64_t lba,
37849ab747fSPaolo Bonzini                                uint32_t len, bool is_write)
37949ab747fSPaolo Bonzini {
38049ab747fSPaolo Bonzini     memset(cdb, 0x0, 16);
38149ab747fSPaolo Bonzini     if (is_write) {
38249ab747fSPaolo Bonzini         cdb[0] = WRITE_16;
38349ab747fSPaolo Bonzini     } else {
38449ab747fSPaolo Bonzini         cdb[0] = READ_16;
38549ab747fSPaolo Bonzini     }
38649ab747fSPaolo Bonzini     cdb[2] = (lba >> 56) & 0xff;
38749ab747fSPaolo Bonzini     cdb[3] = (lba >> 48) & 0xff;
38849ab747fSPaolo Bonzini     cdb[4] = (lba >> 40) & 0xff;
38949ab747fSPaolo Bonzini     cdb[5] = (lba >> 32) & 0xff;
39049ab747fSPaolo Bonzini     cdb[6] = (lba >> 24) & 0xff;
39149ab747fSPaolo Bonzini     cdb[7] = (lba >> 16) & 0xff;
39249ab747fSPaolo Bonzini     cdb[8] = (lba >> 8) & 0xff;
39349ab747fSPaolo Bonzini     cdb[9] = (lba) & 0xff;
39449ab747fSPaolo Bonzini     cdb[10] = (len >> 24) & 0xff;
39549ab747fSPaolo Bonzini     cdb[11] = (len >> 16) & 0xff;
39649ab747fSPaolo Bonzini     cdb[12] = (len >> 8) & 0xff;
39749ab747fSPaolo Bonzini     cdb[13] = (len) & 0xff;
39849ab747fSPaolo Bonzini }
39949ab747fSPaolo Bonzini 
40049ab747fSPaolo Bonzini /*
40149ab747fSPaolo Bonzini  * Utility functions
40249ab747fSPaolo Bonzini  */
40349ab747fSPaolo Bonzini static uint64_t megasas_fw_time(void)
40449ab747fSPaolo Bonzini {
40549ab747fSPaolo Bonzini     struct tm curtime;
40649ab747fSPaolo Bonzini 
40749ab747fSPaolo Bonzini     qemu_get_timedate(&curtime, 0);
4089be38598SEduardo Habkost     return ((uint64_t)curtime.tm_sec & 0xff) << 48 |
40949ab747fSPaolo Bonzini         ((uint64_t)curtime.tm_min & 0xff)  << 40 |
41049ab747fSPaolo Bonzini         ((uint64_t)curtime.tm_hour & 0xff) << 32 |
41149ab747fSPaolo Bonzini         ((uint64_t)curtime.tm_mday & 0xff) << 24 |
41249ab747fSPaolo Bonzini         ((uint64_t)curtime.tm_mon & 0xff)  << 16 |
41349ab747fSPaolo Bonzini         ((uint64_t)(curtime.tm_year + 1900) & 0xffff);
41449ab747fSPaolo Bonzini }
41549ab747fSPaolo Bonzini 
41649ab747fSPaolo Bonzini /*
41749ab747fSPaolo Bonzini  * Default disk sata address
41849ab747fSPaolo Bonzini  * 0x1221 is the magic number as
41949ab747fSPaolo Bonzini  * present in real hardware,
42049ab747fSPaolo Bonzini  * so use it here, too.
42149ab747fSPaolo Bonzini  */
42249ab747fSPaolo Bonzini static uint64_t megasas_get_sata_addr(uint16_t id)
42349ab747fSPaolo Bonzini {
42449ab747fSPaolo Bonzini     uint64_t addr = (0x1221ULL << 48);
4258ef2eb8dSPaolo Bonzini     return addr | ((uint64_t)id << 24);
42649ab747fSPaolo Bonzini }
42749ab747fSPaolo Bonzini 
42849ab747fSPaolo Bonzini /*
42949ab747fSPaolo Bonzini  * Frame handling
43049ab747fSPaolo Bonzini  */
43149ab747fSPaolo Bonzini static int megasas_next_index(MegasasState *s, int index, int limit)
43249ab747fSPaolo Bonzini {
43349ab747fSPaolo Bonzini     index++;
43449ab747fSPaolo Bonzini     if (index == limit) {
43549ab747fSPaolo Bonzini         index = 0;
43649ab747fSPaolo Bonzini     }
43749ab747fSPaolo Bonzini     return index;
43849ab747fSPaolo Bonzini }
43949ab747fSPaolo Bonzini 
44049ab747fSPaolo Bonzini static MegasasCmd *megasas_lookup_frame(MegasasState *s,
44149ab747fSPaolo Bonzini     hwaddr frame)
44249ab747fSPaolo Bonzini {
44349ab747fSPaolo Bonzini     MegasasCmd *cmd = NULL;
44449ab747fSPaolo Bonzini     int num = 0, index;
44549ab747fSPaolo Bonzini 
44649ab747fSPaolo Bonzini     index = s->reply_queue_head;
44749ab747fSPaolo Bonzini 
448f50ab86aSPrasad J Pandit     while (num < s->fw_cmds && index < MEGASAS_MAX_FRAMES) {
44949ab747fSPaolo Bonzini         if (s->frames[index].pa && s->frames[index].pa == frame) {
45049ab747fSPaolo Bonzini             cmd = &s->frames[index];
45149ab747fSPaolo Bonzini             break;
45249ab747fSPaolo Bonzini         }
45349ab747fSPaolo Bonzini         index = megasas_next_index(s, index, s->fw_cmds);
45449ab747fSPaolo Bonzini         num++;
45549ab747fSPaolo Bonzini     }
45649ab747fSPaolo Bonzini 
45749ab747fSPaolo Bonzini     return cmd;
45849ab747fSPaolo Bonzini }
45949ab747fSPaolo Bonzini 
4606df5718bSHannes Reinecke static void megasas_unmap_frame(MegasasState *s, MegasasCmd *cmd)
46149ab747fSPaolo Bonzini {
4626df5718bSHannes Reinecke     PCIDevice *p = PCI_DEVICE(s);
46349ab747fSPaolo Bonzini 
46475f19f8cSPaolo Bonzini     if (cmd->pa_size) {
4656df5718bSHannes Reinecke         pci_dma_unmap(p, cmd->frame, cmd->pa_size, 0, 0);
46675f19f8cSPaolo Bonzini     }
4676df5718bSHannes Reinecke     cmd->frame = NULL;
4686df5718bSHannes Reinecke     cmd->pa = 0;
46975f19f8cSPaolo Bonzini     cmd->pa_size = 0;
47048285ba2SMarc-André Lureau     qemu_sglist_destroy(&cmd->qsg);
4716df5718bSHannes Reinecke     clear_bit(cmd->index, s->frame_map);
47249ab747fSPaolo Bonzini }
47349ab747fSPaolo Bonzini 
4746df5718bSHannes Reinecke /*
4756df5718bSHannes Reinecke  * This absolutely needs to be locked if
4766df5718bSHannes Reinecke  * qemu ever goes multithreaded.
4776df5718bSHannes Reinecke  */
47849ab747fSPaolo Bonzini static MegasasCmd *megasas_enqueue_frame(MegasasState *s,
47949ab747fSPaolo Bonzini     hwaddr frame, uint64_t context, int count)
48049ab747fSPaolo Bonzini {
4811016b239SPaolo Bonzini     PCIDevice *pcid = PCI_DEVICE(s);
48249ab747fSPaolo Bonzini     MegasasCmd *cmd = NULL;
4832e56fbc8SPeter Lieven     int frame_size = MEGASAS_MAX_SGE * sizeof(union mfi_sgl);
48449ab747fSPaolo Bonzini     hwaddr frame_size_p = frame_size;
4856df5718bSHannes Reinecke     unsigned long index;
48649ab747fSPaolo Bonzini 
4876df5718bSHannes Reinecke     index = 0;
4886df5718bSHannes Reinecke     while (index < s->fw_cmds) {
4896df5718bSHannes Reinecke         index = find_next_zero_bit(s->frame_map, s->fw_cmds, index);
4906df5718bSHannes Reinecke         if (!s->frames[index].pa)
4916df5718bSHannes Reinecke             break;
4926df5718bSHannes Reinecke         /* Busy frame found */
4936df5718bSHannes Reinecke         trace_megasas_qf_mapped(index);
4946df5718bSHannes Reinecke     }
4956df5718bSHannes Reinecke     if (index >= s->fw_cmds) {
49649ab747fSPaolo Bonzini         /* All frames busy */
4976df5718bSHannes Reinecke         trace_megasas_qf_busy(frame);
49849ab747fSPaolo Bonzini         return NULL;
49949ab747fSPaolo Bonzini     }
5006df5718bSHannes Reinecke     cmd = &s->frames[index];
5016df5718bSHannes Reinecke     set_bit(index, s->frame_map);
5026df5718bSHannes Reinecke     trace_megasas_qf_new(index, frame);
5036df5718bSHannes Reinecke 
50449ab747fSPaolo Bonzini     cmd->pa = frame;
50549ab747fSPaolo Bonzini     /* Map all possible frames */
5061016b239SPaolo Bonzini     cmd->frame = pci_dma_map(pcid, frame, &frame_size_p, 0);
507fd691855SPrasad J Pandit     if (!cmd->frame || frame_size_p != frame_size) {
50849ab747fSPaolo Bonzini         trace_megasas_qf_map_failed(cmd->index, (unsigned long)frame);
50949ab747fSPaolo Bonzini         if (cmd->frame) {
5106df5718bSHannes Reinecke             megasas_unmap_frame(s, cmd);
51149ab747fSPaolo Bonzini         }
51249ab747fSPaolo Bonzini         s->event_count++;
51349ab747fSPaolo Bonzini         return NULL;
51449ab747fSPaolo Bonzini     }
51549ab747fSPaolo Bonzini     cmd->pa_size = frame_size_p;
51649ab747fSPaolo Bonzini     cmd->context = context;
51749ab747fSPaolo Bonzini     if (!megasas_use_queue64(s)) {
51849ab747fSPaolo Bonzini         cmd->context &= (uint64_t)0xFFFFFFFF;
51949ab747fSPaolo Bonzini     }
52049ab747fSPaolo Bonzini     cmd->count = count;
5215104fac8SPaolo Bonzini     cmd->dcmd_opcode = -1;
52249ab747fSPaolo Bonzini     s->busy++;
52349ab747fSPaolo Bonzini 
524aaf2a859SHannes Reinecke     if (s->consumer_pa) {
52516578c6fSPaolo Bonzini         s->reply_queue_tail = ldl_le_pci_dma(pcid, s->consumer_pa);
526aaf2a859SHannes Reinecke     }
52749ab747fSPaolo Bonzini     trace_megasas_qf_enqueue(cmd->index, cmd->count, cmd->context,
528aaf2a859SHannes Reinecke                              s->reply_queue_head, s->reply_queue_tail, s->busy);
52949ab747fSPaolo Bonzini 
53049ab747fSPaolo Bonzini     return cmd;
53149ab747fSPaolo Bonzini }
53249ab747fSPaolo Bonzini 
53349ab747fSPaolo Bonzini static void megasas_complete_frame(MegasasState *s, uint64_t context)
53449ab747fSPaolo Bonzini {
53552190c1eSAndreas Färber     PCIDevice *pci_dev = PCI_DEVICE(s);
53649ab747fSPaolo Bonzini     int tail, queue_offset;
53749ab747fSPaolo Bonzini 
53849ab747fSPaolo Bonzini     /* Decrement busy count */
53949ab747fSPaolo Bonzini     s->busy--;
54049ab747fSPaolo Bonzini     if (s->reply_queue_pa) {
54149ab747fSPaolo Bonzini         /*
54249ab747fSPaolo Bonzini          * Put command on the reply queue.
54349ab747fSPaolo Bonzini          * Context is opaque, but emulation is running in
54449ab747fSPaolo Bonzini          * little endian. So convert it.
54549ab747fSPaolo Bonzini          */
54649ab747fSPaolo Bonzini         if (megasas_use_queue64(s)) {
5477957ee71SHannes Reinecke             queue_offset = s->reply_queue_head * sizeof(uint64_t);
54816578c6fSPaolo Bonzini             stq_le_pci_dma(pci_dev, s->reply_queue_pa + queue_offset, context);
54949ab747fSPaolo Bonzini         } else {
5507957ee71SHannes Reinecke             queue_offset = s->reply_queue_head * sizeof(uint32_t);
55116578c6fSPaolo Bonzini             stl_le_pci_dma(pci_dev, s->reply_queue_pa + queue_offset, context);
55249ab747fSPaolo Bonzini         }
55316578c6fSPaolo Bonzini         s->reply_queue_tail = ldl_le_pci_dma(pci_dev, s->consumer_pa);
554aaf2a859SHannes Reinecke         trace_megasas_qf_complete(context, s->reply_queue_head,
5557957ee71SHannes Reinecke                                   s->reply_queue_tail, s->busy);
55649ab747fSPaolo Bonzini     }
55749ab747fSPaolo Bonzini 
55849ab747fSPaolo Bonzini     if (megasas_intr_enabled(s)) {
5597957ee71SHannes Reinecke         /* Update reply queue pointer */
56016578c6fSPaolo Bonzini         s->reply_queue_tail = ldl_le_pci_dma(pci_dev, s->consumer_pa);
5617957ee71SHannes Reinecke         tail = s->reply_queue_head;
5627957ee71SHannes Reinecke         s->reply_queue_head = megasas_next_index(s, tail, s->fw_cmds);
5637957ee71SHannes Reinecke         trace_megasas_qf_update(s->reply_queue_head, s->reply_queue_tail,
5647957ee71SHannes Reinecke                                 s->busy);
56516578c6fSPaolo Bonzini         stl_le_pci_dma(pci_dev, s->producer_pa, s->reply_queue_head);
56649ab747fSPaolo Bonzini         /* Notify HBA */
56752190c1eSAndreas Färber         if (msix_enabled(pci_dev)) {
56849ab747fSPaolo Bonzini             trace_megasas_msix_raise(0);
56952190c1eSAndreas Färber             msix_notify(pci_dev, 0);
5704522b69cSHannes Reinecke         } else if (msi_enabled(pci_dev)) {
5714522b69cSHannes Reinecke             trace_megasas_msi_raise(0);
5724522b69cSHannes Reinecke             msi_notify(pci_dev, 0);
57349ab747fSPaolo Bonzini         } else {
5747957ee71SHannes Reinecke             s->doorbell++;
5757957ee71SHannes Reinecke             if (s->doorbell == 1) {
57649ab747fSPaolo Bonzini                 trace_megasas_irq_raise();
5779e64f8a3SMarcel Apfelbaum                 pci_irq_assert(pci_dev);
57849ab747fSPaolo Bonzini             }
57949ab747fSPaolo Bonzini         }
58049ab747fSPaolo Bonzini     } else {
58149ab747fSPaolo Bonzini         trace_megasas_qf_complete_noirq(context);
58249ab747fSPaolo Bonzini     }
58349ab747fSPaolo Bonzini }
58449ab747fSPaolo Bonzini 
5859e55d588SPaolo Bonzini static void megasas_complete_command(MegasasCmd *cmd)
5869e55d588SPaolo Bonzini {
5879e55d588SPaolo Bonzini     cmd->iov_size = 0;
5889e55d588SPaolo Bonzini     cmd->iov_offset = 0;
5899e55d588SPaolo Bonzini 
5909e55d588SPaolo Bonzini     cmd->req->hba_private = NULL;
5919e55d588SPaolo Bonzini     scsi_req_unref(cmd->req);
5929e55d588SPaolo Bonzini     cmd->req = NULL;
5939e55d588SPaolo Bonzini 
5949e55d588SPaolo Bonzini     megasas_unmap_frame(cmd->state, cmd);
5959e55d588SPaolo Bonzini     megasas_complete_frame(cmd->state, cmd->context);
5969e55d588SPaolo Bonzini }
5979e55d588SPaolo Bonzini 
59849ab747fSPaolo Bonzini static void megasas_reset_frames(MegasasState *s)
59949ab747fSPaolo Bonzini {
60049ab747fSPaolo Bonzini     int i;
60149ab747fSPaolo Bonzini     MegasasCmd *cmd;
60249ab747fSPaolo Bonzini 
60349ab747fSPaolo Bonzini     for (i = 0; i < s->fw_cmds; i++) {
60449ab747fSPaolo Bonzini         cmd = &s->frames[i];
60549ab747fSPaolo Bonzini         if (cmd->pa) {
6066df5718bSHannes Reinecke             megasas_unmap_frame(s, cmd);
60749ab747fSPaolo Bonzini         }
60849ab747fSPaolo Bonzini     }
6096df5718bSHannes Reinecke     bitmap_zero(s->frame_map, MEGASAS_MAX_FRAMES);
61049ab747fSPaolo Bonzini }
61149ab747fSPaolo Bonzini 
61249ab747fSPaolo Bonzini static void megasas_abort_command(MegasasCmd *cmd)
61349ab747fSPaolo Bonzini {
6149e55d588SPaolo Bonzini     /* Never abort internal commands.  */
61587e459a8SPaolo Bonzini     if (cmd->dcmd_opcode != -1) {
61687e459a8SPaolo Bonzini         return;
61787e459a8SPaolo Bonzini     }
6189e55d588SPaolo Bonzini     if (cmd->req != NULL) {
61949ab747fSPaolo Bonzini         scsi_req_cancel(cmd->req);
62049ab747fSPaolo Bonzini     }
62149ab747fSPaolo Bonzini }
62249ab747fSPaolo Bonzini 
62349ab747fSPaolo Bonzini static int megasas_init_firmware(MegasasState *s, MegasasCmd *cmd)
62449ab747fSPaolo Bonzini {
6251016b239SPaolo Bonzini     PCIDevice *pcid = PCI_DEVICE(s);
62649ab747fSPaolo Bonzini     uint32_t pa_hi, pa_lo;
62796f8f23aSHannes Reinecke     hwaddr iq_pa, initq_size = sizeof(struct mfi_init_qinfo);
62896f8f23aSHannes Reinecke     struct mfi_init_qinfo *initq = NULL;
62949ab747fSPaolo Bonzini     uint32_t flags;
63049ab747fSPaolo Bonzini     int ret = MFI_STAT_OK;
63149ab747fSPaolo Bonzini 
63296f8f23aSHannes Reinecke     if (s->reply_queue_pa) {
63396f8f23aSHannes Reinecke         trace_megasas_initq_mapped(s->reply_queue_pa);
63496f8f23aSHannes Reinecke         goto out;
63596f8f23aSHannes Reinecke     }
63649ab747fSPaolo Bonzini     pa_lo = le32_to_cpu(cmd->frame->init.qinfo_new_addr_lo);
63749ab747fSPaolo Bonzini     pa_hi = le32_to_cpu(cmd->frame->init.qinfo_new_addr_hi);
63849ab747fSPaolo Bonzini     iq_pa = (((uint64_t) pa_hi << 32) | pa_lo);
63949ab747fSPaolo Bonzini     trace_megasas_init_firmware((uint64_t)iq_pa);
6401016b239SPaolo Bonzini     initq = pci_dma_map(pcid, iq_pa, &initq_size, 0);
64149ab747fSPaolo Bonzini     if (!initq || initq_size != sizeof(*initq)) {
64249ab747fSPaolo Bonzini         trace_megasas_initq_map_failed(cmd->index);
64349ab747fSPaolo Bonzini         s->event_count++;
64449ab747fSPaolo Bonzini         ret = MFI_STAT_MEMORY_NOT_AVAILABLE;
64549ab747fSPaolo Bonzini         goto out;
64649ab747fSPaolo Bonzini     }
64749ab747fSPaolo Bonzini     s->reply_queue_len = le32_to_cpu(initq->rq_entries) & 0xFFFF;
64849ab747fSPaolo Bonzini     if (s->reply_queue_len > s->fw_cmds) {
64949ab747fSPaolo Bonzini         trace_megasas_initq_mismatch(s->reply_queue_len, s->fw_cmds);
65049ab747fSPaolo Bonzini         s->event_count++;
65149ab747fSPaolo Bonzini         ret = MFI_STAT_INVALID_PARAMETER;
65249ab747fSPaolo Bonzini         goto out;
65349ab747fSPaolo Bonzini     }
65449ab747fSPaolo Bonzini     pa_lo = le32_to_cpu(initq->rq_addr_lo);
65549ab747fSPaolo Bonzini     pa_hi = le32_to_cpu(initq->rq_addr_hi);
65649ab747fSPaolo Bonzini     s->reply_queue_pa = ((uint64_t) pa_hi << 32) | pa_lo;
65749ab747fSPaolo Bonzini     pa_lo = le32_to_cpu(initq->ci_addr_lo);
65849ab747fSPaolo Bonzini     pa_hi = le32_to_cpu(initq->ci_addr_hi);
65949ab747fSPaolo Bonzini     s->consumer_pa = ((uint64_t) pa_hi << 32) | pa_lo;
66049ab747fSPaolo Bonzini     pa_lo = le32_to_cpu(initq->pi_addr_lo);
66149ab747fSPaolo Bonzini     pa_hi = le32_to_cpu(initq->pi_addr_hi);
66249ab747fSPaolo Bonzini     s->producer_pa = ((uint64_t) pa_hi << 32) | pa_lo;
66316578c6fSPaolo Bonzini     s->reply_queue_head = ldl_le_pci_dma(pcid, s->producer_pa);
664b60bdd1fSPrasad J Pandit     s->reply_queue_head %= MEGASAS_MAX_FRAMES;
66516578c6fSPaolo Bonzini     s->reply_queue_tail = ldl_le_pci_dma(pcid, s->consumer_pa);
666b60bdd1fSPrasad J Pandit     s->reply_queue_tail %= MEGASAS_MAX_FRAMES;
66749ab747fSPaolo Bonzini     flags = le32_to_cpu(initq->flags);
66849ab747fSPaolo Bonzini     if (flags & MFI_QUEUE_FLAG_CONTEXT64) {
66949ab747fSPaolo Bonzini         s->flags |= MEGASAS_MASK_USE_QUEUE64;
67049ab747fSPaolo Bonzini     }
67149ab747fSPaolo Bonzini     trace_megasas_init_queue((unsigned long)s->reply_queue_pa,
67249ab747fSPaolo Bonzini                              s->reply_queue_len, s->reply_queue_head,
67349ab747fSPaolo Bonzini                              s->reply_queue_tail, flags);
67449ab747fSPaolo Bonzini     megasas_reset_frames(s);
67549ab747fSPaolo Bonzini     s->fw_state = MFI_FWSTATE_OPERATIONAL;
67649ab747fSPaolo Bonzini out:
67749ab747fSPaolo Bonzini     if (initq) {
6781016b239SPaolo Bonzini         pci_dma_unmap(pcid, initq, initq_size, 0, 0);
67949ab747fSPaolo Bonzini     }
68049ab747fSPaolo Bonzini     return ret;
68149ab747fSPaolo Bonzini }
68249ab747fSPaolo Bonzini 
68349ab747fSPaolo Bonzini static int megasas_map_dcmd(MegasasState *s, MegasasCmd *cmd)
68449ab747fSPaolo Bonzini {
68549ab747fSPaolo Bonzini     dma_addr_t iov_pa, iov_size;
68624c0c77aSPaolo Bonzini     int iov_count;
68749ab747fSPaolo Bonzini 
68849ab747fSPaolo Bonzini     cmd->flags = le16_to_cpu(cmd->frame->header.flags);
68924c0c77aSPaolo Bonzini     iov_count = cmd->frame->header.sge_count;
69024c0c77aSPaolo Bonzini     if (!iov_count) {
69149ab747fSPaolo Bonzini         trace_megasas_dcmd_zero_sge(cmd->index);
69249ab747fSPaolo Bonzini         cmd->iov_size = 0;
69349ab747fSPaolo Bonzini         return 0;
69424c0c77aSPaolo Bonzini     } else if (iov_count > 1) {
69524c0c77aSPaolo Bonzini         trace_megasas_dcmd_invalid_sge(cmd->index, iov_count);
69649ab747fSPaolo Bonzini         cmd->iov_size = 0;
697765a7070SPaolo Bonzini         return -EINVAL;
69849ab747fSPaolo Bonzini     }
69949ab747fSPaolo Bonzini     iov_pa = megasas_sgl_get_addr(cmd, &cmd->frame->dcmd.sgl);
70049ab747fSPaolo Bonzini     iov_size = megasas_sgl_get_len(cmd, &cmd->frame->dcmd.sgl);
70152190c1eSAndreas Färber     pci_dma_sglist_init(&cmd->qsg, PCI_DEVICE(s), 1);
70249ab747fSPaolo Bonzini     qemu_sglist_add(&cmd->qsg, iov_pa, iov_size);
70349ab747fSPaolo Bonzini     cmd->iov_size = iov_size;
704765a7070SPaolo Bonzini     return 0;
70549ab747fSPaolo Bonzini }
70649ab747fSPaolo Bonzini 
70749ab747fSPaolo Bonzini static void megasas_finish_dcmd(MegasasCmd *cmd, uint32_t iov_size)
70849ab747fSPaolo Bonzini {
70949ab747fSPaolo Bonzini     trace_megasas_finish_dcmd(cmd->index, iov_size);
71049ab747fSPaolo Bonzini 
71149ab747fSPaolo Bonzini     if (iov_size > cmd->iov_size) {
71249ab747fSPaolo Bonzini         if (megasas_frame_is_ieee_sgl(cmd)) {
71349ab747fSPaolo Bonzini             cmd->frame->dcmd.sgl.sg_skinny->len = cpu_to_le32(iov_size);
71449ab747fSPaolo Bonzini         } else if (megasas_frame_is_sgl64(cmd)) {
71549ab747fSPaolo Bonzini             cmd->frame->dcmd.sgl.sg64->len = cpu_to_le32(iov_size);
71649ab747fSPaolo Bonzini         } else {
71749ab747fSPaolo Bonzini             cmd->frame->dcmd.sgl.sg32->len = cpu_to_le32(iov_size);
71849ab747fSPaolo Bonzini         }
71949ab747fSPaolo Bonzini     }
72049ab747fSPaolo Bonzini }
72149ab747fSPaolo Bonzini 
72249ab747fSPaolo Bonzini static int megasas_ctrl_get_info(MegasasState *s, MegasasCmd *cmd)
72349ab747fSPaolo Bonzini {
72452190c1eSAndreas Färber     PCIDevice *pci_dev = PCI_DEVICE(s);
725e23d0498SHannes Reinecke     PCIDeviceClass *pci_class = PCI_DEVICE_GET_CLASS(pci_dev);
726e23d0498SHannes Reinecke     MegasasBaseClass *base_class = MEGASAS_DEVICE_GET_CLASS(s);
72749ab747fSPaolo Bonzini     struct mfi_ctrl_info info;
72849ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(info);
72949ab747fSPaolo Bonzini     BusChild *kid;
7303f2cd4ddSHannes Reinecke     int num_pd_disks = 0;
73149ab747fSPaolo Bonzini 
73236fef36bSP J P     memset(&info, 0x0, dcmd_size);
73349ab747fSPaolo Bonzini     if (cmd->iov_size < dcmd_size) {
73449ab747fSPaolo Bonzini         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
73549ab747fSPaolo Bonzini                                             dcmd_size);
73649ab747fSPaolo Bonzini         return MFI_STAT_INVALID_PARAMETER;
73749ab747fSPaolo Bonzini     }
73849ab747fSPaolo Bonzini 
739e23d0498SHannes Reinecke     info.pci.vendor = cpu_to_le16(pci_class->vendor_id);
740e23d0498SHannes Reinecke     info.pci.device = cpu_to_le16(pci_class->device_id);
741e23d0498SHannes Reinecke     info.pci.subvendor = cpu_to_le16(pci_class->subsystem_vendor_id);
742e23d0498SHannes Reinecke     info.pci.subdevice = cpu_to_le16(pci_class->subsystem_id);
74349ab747fSPaolo Bonzini 
74449ab747fSPaolo Bonzini     /*
74549ab747fSPaolo Bonzini      * For some reason the firmware supports
74649ab747fSPaolo Bonzini      * only up to 8 device ports.
74749ab747fSPaolo Bonzini      * Despite supporting a far larger number
74849ab747fSPaolo Bonzini      * of devices for the physical devices.
74949ab747fSPaolo Bonzini      * So just display the first 8 devices
75049ab747fSPaolo Bonzini      * in the device port list, independent
75149ab747fSPaolo Bonzini      * of how many logical devices are actually
75249ab747fSPaolo Bonzini      * present.
75349ab747fSPaolo Bonzini      */
75449ab747fSPaolo Bonzini     info.host.type = MFI_INFO_HOST_PCIE;
75549ab747fSPaolo Bonzini     info.device.type = MFI_INFO_DEV_SAS3G;
75649ab747fSPaolo Bonzini     info.device.port_count = 8;
75749ab747fSPaolo Bonzini     QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
758e1dc6815SCao jin         SCSIDevice *sdev = SCSI_DEVICE(kid->child);
7593f2cd4ddSHannes Reinecke         uint16_t pd_id;
76049ab747fSPaolo Bonzini 
7613f2cd4ddSHannes Reinecke         if (num_pd_disks < 8) {
7623f2cd4ddSHannes Reinecke             pd_id = ((sdev->id & 0xFF) << 8) | (sdev->lun & 0xFF);
7633f2cd4ddSHannes Reinecke             info.device.port_addr[num_pd_disks] =
7643f2cd4ddSHannes Reinecke                 cpu_to_le64(megasas_get_sata_addr(pd_id));
76549ab747fSPaolo Bonzini         }
7663f2cd4ddSHannes Reinecke         num_pd_disks++;
76749ab747fSPaolo Bonzini     }
76849ab747fSPaolo Bonzini 
769e23d0498SHannes Reinecke     memcpy(info.product_name, base_class->product_name, 24);
77049ab747fSPaolo Bonzini     snprintf(info.serial_number, 32, "%s", s->hba_serial);
77169fbd0eaSEduardo Habkost     snprintf(info.package_version, 0x60, "%s-QEMU", qemu_hw_version());
77249ab747fSPaolo Bonzini     memcpy(info.image_component[0].name, "APP", 3);
773e23d0498SHannes Reinecke     snprintf(info.image_component[0].version, 10, "%s-QEMU",
774e23d0498SHannes Reinecke              base_class->product_version);
7755a7733b0SOlaf Hering     memcpy(info.image_component[0].build_date, "Apr  1 2014", 11);
7765a7733b0SOlaf Hering     memcpy(info.image_component[0].build_time, "12:34:56", 8);
77749ab747fSPaolo Bonzini     info.image_component_count = 1;
77852190c1eSAndreas Färber     if (pci_dev->has_rom) {
77949ab747fSPaolo Bonzini         uint8_t biosver[32];
78049ab747fSPaolo Bonzini         uint8_t *ptr;
78149ab747fSPaolo Bonzini 
78252190c1eSAndreas Färber         ptr = memory_region_get_ram_ptr(&pci_dev->rom);
78349ab747fSPaolo Bonzini         memcpy(biosver, ptr + 0x41, 31);
784844864fbSPrasad J Pandit         biosver[31] = 0;
78549ab747fSPaolo Bonzini         memcpy(info.image_component[1].name, "BIOS", 4);
78649ab747fSPaolo Bonzini         memcpy(info.image_component[1].version, biosver,
78749ab747fSPaolo Bonzini                strlen((const char *)biosver));
78849ab747fSPaolo Bonzini         info.image_component_count++;
78949ab747fSPaolo Bonzini     }
79049ab747fSPaolo Bonzini     info.current_fw_time = cpu_to_le32(megasas_fw_time());
79149ab747fSPaolo Bonzini     info.max_arms = 32;
79249ab747fSPaolo Bonzini     info.max_spans = 8;
79349ab747fSPaolo Bonzini     info.max_arrays = MEGASAS_MAX_ARRAYS;
7943f2cd4ddSHannes Reinecke     info.max_lds = MFI_MAX_LD;
79549ab747fSPaolo Bonzini     info.max_cmds = cpu_to_le16(s->fw_cmds);
79649ab747fSPaolo Bonzini     info.max_sg_elements = cpu_to_le16(s->fw_sge);
79749ab747fSPaolo Bonzini     info.max_request_size = cpu_to_le32(MEGASAS_MAX_SECTORS);
7983f2cd4ddSHannes Reinecke     if (!megasas_is_jbod(s))
7993f2cd4ddSHannes Reinecke         info.lds_present = cpu_to_le16(num_pd_disks);
8003f2cd4ddSHannes Reinecke     info.pd_present = cpu_to_le16(num_pd_disks);
8013f2cd4ddSHannes Reinecke     info.pd_disks_present = cpu_to_le16(num_pd_disks);
80249ab747fSPaolo Bonzini     info.hw_present = cpu_to_le32(MFI_INFO_HW_NVRAM |
80349ab747fSPaolo Bonzini                                    MFI_INFO_HW_MEM |
80449ab747fSPaolo Bonzini                                    MFI_INFO_HW_FLASH);
80549ab747fSPaolo Bonzini     info.memory_size = cpu_to_le16(512);
80649ab747fSPaolo Bonzini     info.nvram_size = cpu_to_le16(32);
80749ab747fSPaolo Bonzini     info.flash_size = cpu_to_le16(16);
80849ab747fSPaolo Bonzini     info.raid_levels = cpu_to_le32(MFI_INFO_RAID_0);
80949ab747fSPaolo Bonzini     info.adapter_ops = cpu_to_le32(MFI_INFO_AOPS_RBLD_RATE |
81049ab747fSPaolo Bonzini                                     MFI_INFO_AOPS_SELF_DIAGNOSTIC |
81149ab747fSPaolo Bonzini                                     MFI_INFO_AOPS_MIXED_ARRAY);
81249ab747fSPaolo Bonzini     info.ld_ops = cpu_to_le32(MFI_INFO_LDOPS_DISK_CACHE_POLICY |
81349ab747fSPaolo Bonzini                                MFI_INFO_LDOPS_ACCESS_POLICY |
81449ab747fSPaolo Bonzini                                MFI_INFO_LDOPS_IO_POLICY |
81549ab747fSPaolo Bonzini                                MFI_INFO_LDOPS_WRITE_POLICY |
81649ab747fSPaolo Bonzini                                MFI_INFO_LDOPS_READ_POLICY);
81749ab747fSPaolo Bonzini     info.max_strips_per_io = cpu_to_le16(s->fw_sge);
81849ab747fSPaolo Bonzini     info.stripe_sz_ops.min = 3;
819786a4ea8SStefan Hajnoczi     info.stripe_sz_ops.max = ctz32(MEGASAS_MAX_SECTORS + 1);
82049ab747fSPaolo Bonzini     info.properties.pred_fail_poll_interval = cpu_to_le16(300);
82149ab747fSPaolo Bonzini     info.properties.intr_throttle_cnt = cpu_to_le16(16);
82249ab747fSPaolo Bonzini     info.properties.intr_throttle_timeout = cpu_to_le16(50);
82349ab747fSPaolo Bonzini     info.properties.rebuild_rate = 30;
82449ab747fSPaolo Bonzini     info.properties.patrol_read_rate = 30;
82549ab747fSPaolo Bonzini     info.properties.bgi_rate = 30;
82649ab747fSPaolo Bonzini     info.properties.cc_rate = 30;
82749ab747fSPaolo Bonzini     info.properties.recon_rate = 30;
82849ab747fSPaolo Bonzini     info.properties.cache_flush_interval = 4;
82949ab747fSPaolo Bonzini     info.properties.spinup_drv_cnt = 2;
83049ab747fSPaolo Bonzini     info.properties.spinup_delay = 6;
83149ab747fSPaolo Bonzini     info.properties.ecc_bucket_size = 15;
83249ab747fSPaolo Bonzini     info.properties.ecc_bucket_leak_rate = cpu_to_le16(1440);
83349ab747fSPaolo Bonzini     info.properties.expose_encl_devices = 1;
83449ab747fSPaolo Bonzini     info.properties.OnOffProperties = cpu_to_le32(MFI_CTRL_PROP_EnableJBOD);
83549ab747fSPaolo Bonzini     info.pd_ops = cpu_to_le32(MFI_INFO_PDOPS_FORCE_ONLINE |
83649ab747fSPaolo Bonzini                                MFI_INFO_PDOPS_FORCE_OFFLINE);
83749ab747fSPaolo Bonzini     info.pd_mix_support = cpu_to_le32(MFI_INFO_PDMIX_SAS |
83849ab747fSPaolo Bonzini                                        MFI_INFO_PDMIX_SATA |
83949ab747fSPaolo Bonzini                                        MFI_INFO_PDMIX_LD);
84049ab747fSPaolo Bonzini 
84149ab747fSPaolo Bonzini     cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg);
84249ab747fSPaolo Bonzini     return MFI_STAT_OK;
84349ab747fSPaolo Bonzini }
84449ab747fSPaolo Bonzini 
84549ab747fSPaolo Bonzini static int megasas_mfc_get_defaults(MegasasState *s, MegasasCmd *cmd)
84649ab747fSPaolo Bonzini {
84749ab747fSPaolo Bonzini     struct mfi_defaults info;
84849ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(struct mfi_defaults);
84949ab747fSPaolo Bonzini 
85049ab747fSPaolo Bonzini     memset(&info, 0x0, dcmd_size);
85149ab747fSPaolo Bonzini     if (cmd->iov_size < dcmd_size) {
85249ab747fSPaolo Bonzini         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
85349ab747fSPaolo Bonzini                                             dcmd_size);
85449ab747fSPaolo Bonzini         return MFI_STAT_INVALID_PARAMETER;
85549ab747fSPaolo Bonzini     }
85649ab747fSPaolo Bonzini 
85749ab747fSPaolo Bonzini     info.sas_addr = cpu_to_le64(s->sas_addr);
85849ab747fSPaolo Bonzini     info.stripe_size = 3;
85949ab747fSPaolo Bonzini     info.flush_time = 4;
86049ab747fSPaolo Bonzini     info.background_rate = 30;
86149ab747fSPaolo Bonzini     info.allow_mix_in_enclosure = 1;
86249ab747fSPaolo Bonzini     info.allow_mix_in_ld = 1;
86349ab747fSPaolo Bonzini     info.direct_pd_mapping = 1;
86449ab747fSPaolo Bonzini     /* Enable for BIOS support */
86549ab747fSPaolo Bonzini     info.bios_enumerate_lds = 1;
86649ab747fSPaolo Bonzini     info.disable_ctrl_r = 1;
86749ab747fSPaolo Bonzini     info.expose_enclosure_devices = 1;
86849ab747fSPaolo Bonzini     info.disable_preboot_cli = 1;
86949ab747fSPaolo Bonzini     info.cluster_disable = 1;
87049ab747fSPaolo Bonzini 
87149ab747fSPaolo Bonzini     cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg);
87249ab747fSPaolo Bonzini     return MFI_STAT_OK;
87349ab747fSPaolo Bonzini }
87449ab747fSPaolo Bonzini 
87549ab747fSPaolo Bonzini static int megasas_dcmd_get_bios_info(MegasasState *s, MegasasCmd *cmd)
87649ab747fSPaolo Bonzini {
87749ab747fSPaolo Bonzini     struct mfi_bios_data info;
87849ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(info);
87949ab747fSPaolo Bonzini 
88049ab747fSPaolo Bonzini     memset(&info, 0x0, dcmd_size);
88149ab747fSPaolo Bonzini     if (cmd->iov_size < dcmd_size) {
88249ab747fSPaolo Bonzini         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
88349ab747fSPaolo Bonzini                                             dcmd_size);
88449ab747fSPaolo Bonzini         return MFI_STAT_INVALID_PARAMETER;
88549ab747fSPaolo Bonzini     }
88649ab747fSPaolo Bonzini     info.continue_on_error = 1;
88749ab747fSPaolo Bonzini     info.verbose = 1;
88849ab747fSPaolo Bonzini     if (megasas_is_jbod(s)) {
88949ab747fSPaolo Bonzini         info.expose_all_drives = 1;
89049ab747fSPaolo Bonzini     }
89149ab747fSPaolo Bonzini 
89249ab747fSPaolo Bonzini     cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg);
89349ab747fSPaolo Bonzini     return MFI_STAT_OK;
89449ab747fSPaolo Bonzini }
89549ab747fSPaolo Bonzini 
89649ab747fSPaolo Bonzini static int megasas_dcmd_get_fw_time(MegasasState *s, MegasasCmd *cmd)
89749ab747fSPaolo Bonzini {
89849ab747fSPaolo Bonzini     uint64_t fw_time;
89949ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(fw_time);
90049ab747fSPaolo Bonzini 
90149ab747fSPaolo Bonzini     fw_time = cpu_to_le64(megasas_fw_time());
90249ab747fSPaolo Bonzini 
90349ab747fSPaolo Bonzini     cmd->iov_size -= dma_buf_read((uint8_t *)&fw_time, dcmd_size, &cmd->qsg);
90449ab747fSPaolo Bonzini     return MFI_STAT_OK;
90549ab747fSPaolo Bonzini }
90649ab747fSPaolo Bonzini 
90749ab747fSPaolo Bonzini static int megasas_dcmd_set_fw_time(MegasasState *s, MegasasCmd *cmd)
90849ab747fSPaolo Bonzini {
90949ab747fSPaolo Bonzini     uint64_t fw_time;
91049ab747fSPaolo Bonzini 
91149ab747fSPaolo Bonzini     /* This is a dummy; setting of firmware time is not allowed */
91249ab747fSPaolo Bonzini     memcpy(&fw_time, cmd->frame->dcmd.mbox, sizeof(fw_time));
91349ab747fSPaolo Bonzini 
91449ab747fSPaolo Bonzini     trace_megasas_dcmd_set_fw_time(cmd->index, fw_time);
91549ab747fSPaolo Bonzini     fw_time = cpu_to_le64(megasas_fw_time());
91649ab747fSPaolo Bonzini     return MFI_STAT_OK;
91749ab747fSPaolo Bonzini }
91849ab747fSPaolo Bonzini 
91949ab747fSPaolo Bonzini static int megasas_event_info(MegasasState *s, MegasasCmd *cmd)
92049ab747fSPaolo Bonzini {
92149ab747fSPaolo Bonzini     struct mfi_evt_log_state info;
92249ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(info);
92349ab747fSPaolo Bonzini 
92449ab747fSPaolo Bonzini     memset(&info, 0, dcmd_size);
92549ab747fSPaolo Bonzini 
92649ab747fSPaolo Bonzini     info.newest_seq_num = cpu_to_le32(s->event_count);
92749ab747fSPaolo Bonzini     info.shutdown_seq_num = cpu_to_le32(s->shutdown_event);
92849ab747fSPaolo Bonzini     info.boot_seq_num = cpu_to_le32(s->boot_event);
92949ab747fSPaolo Bonzini 
93049ab747fSPaolo Bonzini     cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg);
93149ab747fSPaolo Bonzini     return MFI_STAT_OK;
93249ab747fSPaolo Bonzini }
93349ab747fSPaolo Bonzini 
93449ab747fSPaolo Bonzini static int megasas_event_wait(MegasasState *s, MegasasCmd *cmd)
93549ab747fSPaolo Bonzini {
93649ab747fSPaolo Bonzini     union mfi_evt event;
93749ab747fSPaolo Bonzini 
93849ab747fSPaolo Bonzini     if (cmd->iov_size < sizeof(struct mfi_evt_detail)) {
93949ab747fSPaolo Bonzini         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
94049ab747fSPaolo Bonzini                                             sizeof(struct mfi_evt_detail));
94149ab747fSPaolo Bonzini         return MFI_STAT_INVALID_PARAMETER;
94249ab747fSPaolo Bonzini     }
94349ab747fSPaolo Bonzini     s->event_count = cpu_to_le32(cmd->frame->dcmd.mbox[0]);
94449ab747fSPaolo Bonzini     event.word = cpu_to_le32(cmd->frame->dcmd.mbox[4]);
94549ab747fSPaolo Bonzini     s->event_locale = event.members.locale;
94649ab747fSPaolo Bonzini     s->event_class = event.members.class;
94749ab747fSPaolo Bonzini     s->event_cmd = cmd;
94849ab747fSPaolo Bonzini     /* Decrease busy count; event frame doesn't count here */
94949ab747fSPaolo Bonzini     s->busy--;
95049ab747fSPaolo Bonzini     cmd->iov_size = sizeof(struct mfi_evt_detail);
95149ab747fSPaolo Bonzini     return MFI_STAT_INVALID_STATUS;
95249ab747fSPaolo Bonzini }
95349ab747fSPaolo Bonzini 
95449ab747fSPaolo Bonzini static int megasas_dcmd_pd_get_list(MegasasState *s, MegasasCmd *cmd)
95549ab747fSPaolo Bonzini {
95649ab747fSPaolo Bonzini     struct mfi_pd_list info;
95749ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(info);
95849ab747fSPaolo Bonzini     BusChild *kid;
95949ab747fSPaolo Bonzini     uint32_t offset, dcmd_limit, num_pd_disks = 0, max_pd_disks;
96049ab747fSPaolo Bonzini 
96149ab747fSPaolo Bonzini     memset(&info, 0, dcmd_size);
96249ab747fSPaolo Bonzini     offset = 8;
96349ab747fSPaolo Bonzini     dcmd_limit = offset + sizeof(struct mfi_pd_address);
96449ab747fSPaolo Bonzini     if (cmd->iov_size < dcmd_limit) {
96549ab747fSPaolo Bonzini         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
96649ab747fSPaolo Bonzini                                             dcmd_limit);
96749ab747fSPaolo Bonzini         return MFI_STAT_INVALID_PARAMETER;
96849ab747fSPaolo Bonzini     }
96949ab747fSPaolo Bonzini 
97049ab747fSPaolo Bonzini     max_pd_disks = (cmd->iov_size - offset) / sizeof(struct mfi_pd_address);
9713f2cd4ddSHannes Reinecke     if (max_pd_disks > MFI_MAX_SYS_PDS) {
9723f2cd4ddSHannes Reinecke         max_pd_disks = MFI_MAX_SYS_PDS;
97349ab747fSPaolo Bonzini     }
97449ab747fSPaolo Bonzini     QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
975e1dc6815SCao jin         SCSIDevice *sdev = SCSI_DEVICE(kid->child);
9763f2cd4ddSHannes Reinecke         uint16_t pd_id;
97749ab747fSPaolo Bonzini 
9783f2cd4ddSHannes Reinecke         if (num_pd_disks >= max_pd_disks)
9793f2cd4ddSHannes Reinecke             break;
9803f2cd4ddSHannes Reinecke 
9813f2cd4ddSHannes Reinecke         pd_id = ((sdev->id & 0xFF) << 8) | (sdev->lun & 0xFF);
9823f2cd4ddSHannes Reinecke         info.addr[num_pd_disks].device_id = cpu_to_le16(pd_id);
98349ab747fSPaolo Bonzini         info.addr[num_pd_disks].encl_device_id = 0xFFFF;
98449ab747fSPaolo Bonzini         info.addr[num_pd_disks].encl_index = 0;
9853f2cd4ddSHannes Reinecke         info.addr[num_pd_disks].slot_number = sdev->id & 0xFF;
98649ab747fSPaolo Bonzini         info.addr[num_pd_disks].scsi_dev_type = sdev->type;
98749ab747fSPaolo Bonzini         info.addr[num_pd_disks].connect_port_bitmap = 0x1;
98849ab747fSPaolo Bonzini         info.addr[num_pd_disks].sas_addr[0] =
9893f2cd4ddSHannes Reinecke             cpu_to_le64(megasas_get_sata_addr(pd_id));
99049ab747fSPaolo Bonzini         num_pd_disks++;
99149ab747fSPaolo Bonzini         offset += sizeof(struct mfi_pd_address);
99249ab747fSPaolo Bonzini     }
99349ab747fSPaolo Bonzini     trace_megasas_dcmd_pd_get_list(cmd->index, num_pd_disks,
99449ab747fSPaolo Bonzini                                    max_pd_disks, offset);
99549ab747fSPaolo Bonzini 
99649ab747fSPaolo Bonzini     info.size = cpu_to_le32(offset);
99749ab747fSPaolo Bonzini     info.count = cpu_to_le32(num_pd_disks);
99849ab747fSPaolo Bonzini 
99949ab747fSPaolo Bonzini     cmd->iov_size -= dma_buf_read((uint8_t *)&info, offset, &cmd->qsg);
100049ab747fSPaolo Bonzini     return MFI_STAT_OK;
100149ab747fSPaolo Bonzini }
100249ab747fSPaolo Bonzini 
100349ab747fSPaolo Bonzini static int megasas_dcmd_pd_list_query(MegasasState *s, MegasasCmd *cmd)
100449ab747fSPaolo Bonzini {
100549ab747fSPaolo Bonzini     uint16_t flags;
100649ab747fSPaolo Bonzini 
100749ab747fSPaolo Bonzini     /* mbox0 contains flags */
100849ab747fSPaolo Bonzini     flags = le16_to_cpu(cmd->frame->dcmd.mbox[0]);
100949ab747fSPaolo Bonzini     trace_megasas_dcmd_pd_list_query(cmd->index, flags);
101049ab747fSPaolo Bonzini     if (flags == MR_PD_QUERY_TYPE_ALL ||
101149ab747fSPaolo Bonzini         megasas_is_jbod(s)) {
101249ab747fSPaolo Bonzini         return megasas_dcmd_pd_get_list(s, cmd);
101349ab747fSPaolo Bonzini     }
101449ab747fSPaolo Bonzini 
101549ab747fSPaolo Bonzini     return MFI_STAT_OK;
101649ab747fSPaolo Bonzini }
101749ab747fSPaolo Bonzini 
101849ab747fSPaolo Bonzini static int megasas_pd_get_info_submit(SCSIDevice *sdev, int lun,
101949ab747fSPaolo Bonzini                                       MegasasCmd *cmd)
102049ab747fSPaolo Bonzini {
102149ab747fSPaolo Bonzini     struct mfi_pd_info *info = cmd->iov_buf;
102249ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(struct mfi_pd_info);
102349ab747fSPaolo Bonzini     uint64_t pd_size;
10243f2cd4ddSHannes Reinecke     uint16_t pd_id = ((sdev->id & 0xFF) << 8) | (lun & 0xFF);
102549ab747fSPaolo Bonzini     uint8_t cmdbuf[6];
102649ab747fSPaolo Bonzini     size_t len, resid;
102749ab747fSPaolo Bonzini 
102849ab747fSPaolo Bonzini     if (!cmd->iov_buf) {
10290bd0adbeSMarkus Armbruster         cmd->iov_buf = g_malloc0(dcmd_size);
103049ab747fSPaolo Bonzini         info = cmd->iov_buf;
103149ab747fSPaolo Bonzini         info->inquiry_data[0] = 0x7f; /* Force PQual 0x3, PType 0x1f */
103249ab747fSPaolo Bonzini         info->vpd_page83[0] = 0x7f;
103349ab747fSPaolo Bonzini         megasas_setup_inquiry(cmdbuf, 0, sizeof(info->inquiry_data));
103487e459a8SPaolo Bonzini         cmd->req = scsi_req_new(sdev, cmd->index, lun, cmdbuf, cmd);
103587e459a8SPaolo Bonzini         if (!cmd->req) {
103649ab747fSPaolo Bonzini             trace_megasas_dcmd_req_alloc_failed(cmd->index,
103749ab747fSPaolo Bonzini                                                 "PD get info std inquiry");
103849ab747fSPaolo Bonzini             g_free(cmd->iov_buf);
103949ab747fSPaolo Bonzini             cmd->iov_buf = NULL;
104049ab747fSPaolo Bonzini             return MFI_STAT_FLASH_ALLOC_FAIL;
104149ab747fSPaolo Bonzini         }
104249ab747fSPaolo Bonzini         trace_megasas_dcmd_internal_submit(cmd->index,
104349ab747fSPaolo Bonzini                                            "PD get info std inquiry", lun);
104487e459a8SPaolo Bonzini         len = scsi_req_enqueue(cmd->req);
104549ab747fSPaolo Bonzini         if (len > 0) {
104649ab747fSPaolo Bonzini             cmd->iov_size = len;
104787e459a8SPaolo Bonzini             scsi_req_continue(cmd->req);
104849ab747fSPaolo Bonzini         }
104949ab747fSPaolo Bonzini         return MFI_STAT_INVALID_STATUS;
105049ab747fSPaolo Bonzini     } else if (info->inquiry_data[0] != 0x7f && info->vpd_page83[0] == 0x7f) {
105149ab747fSPaolo Bonzini         megasas_setup_inquiry(cmdbuf, 0x83, sizeof(info->vpd_page83));
105287e459a8SPaolo Bonzini         cmd->req = scsi_req_new(sdev, cmd->index, lun, cmdbuf, cmd);
105387e459a8SPaolo Bonzini         if (!cmd->req) {
105449ab747fSPaolo Bonzini             trace_megasas_dcmd_req_alloc_failed(cmd->index,
105549ab747fSPaolo Bonzini                                                 "PD get info vpd inquiry");
105649ab747fSPaolo Bonzini             return MFI_STAT_FLASH_ALLOC_FAIL;
105749ab747fSPaolo Bonzini         }
105849ab747fSPaolo Bonzini         trace_megasas_dcmd_internal_submit(cmd->index,
105949ab747fSPaolo Bonzini                                            "PD get info vpd inquiry", lun);
106087e459a8SPaolo Bonzini         len = scsi_req_enqueue(cmd->req);
106149ab747fSPaolo Bonzini         if (len > 0) {
106249ab747fSPaolo Bonzini             cmd->iov_size = len;
106387e459a8SPaolo Bonzini             scsi_req_continue(cmd->req);
106449ab747fSPaolo Bonzini         }
106549ab747fSPaolo Bonzini         return MFI_STAT_INVALID_STATUS;
106649ab747fSPaolo Bonzini     }
106749ab747fSPaolo Bonzini     /* Finished, set FW state */
106849ab747fSPaolo Bonzini     if ((info->inquiry_data[0] >> 5) == 0) {
106949ab747fSPaolo Bonzini         if (megasas_is_jbod(cmd->state)) {
107049ab747fSPaolo Bonzini             info->fw_state = cpu_to_le16(MFI_PD_STATE_SYSTEM);
107149ab747fSPaolo Bonzini         } else {
107249ab747fSPaolo Bonzini             info->fw_state = cpu_to_le16(MFI_PD_STATE_ONLINE);
107349ab747fSPaolo Bonzini         }
107449ab747fSPaolo Bonzini     } else {
107549ab747fSPaolo Bonzini         info->fw_state = cpu_to_le16(MFI_PD_STATE_OFFLINE);
107649ab747fSPaolo Bonzini     }
107749ab747fSPaolo Bonzini 
10783f2cd4ddSHannes Reinecke     info->ref.v.device_id = cpu_to_le16(pd_id);
107949ab747fSPaolo Bonzini     info->state.ddf.pd_type = cpu_to_le16(MFI_PD_DDF_TYPE_IN_VD|
108049ab747fSPaolo Bonzini                                           MFI_PD_DDF_TYPE_INTF_SAS);
10814be74634SMarkus Armbruster     blk_get_geometry(sdev->conf.blk, &pd_size);
108249ab747fSPaolo Bonzini     info->raw_size = cpu_to_le64(pd_size);
108349ab747fSPaolo Bonzini     info->non_coerced_size = cpu_to_le64(pd_size);
108449ab747fSPaolo Bonzini     info->coerced_size = cpu_to_le64(pd_size);
108549ab747fSPaolo Bonzini     info->encl_device_id = 0xFFFF;
108649ab747fSPaolo Bonzini     info->slot_number = (sdev->id & 0xFF);
108749ab747fSPaolo Bonzini     info->path_info.count = 1;
108849ab747fSPaolo Bonzini     info->path_info.sas_addr[0] =
10893f2cd4ddSHannes Reinecke         cpu_to_le64(megasas_get_sata_addr(pd_id));
109049ab747fSPaolo Bonzini     info->connected_port_bitmap = 0x1;
109149ab747fSPaolo Bonzini     info->device_speed = 1;
109249ab747fSPaolo Bonzini     info->link_speed = 1;
109349ab747fSPaolo Bonzini     resid = dma_buf_read(cmd->iov_buf, dcmd_size, &cmd->qsg);
109449ab747fSPaolo Bonzini     g_free(cmd->iov_buf);
109549ab747fSPaolo Bonzini     cmd->iov_size = dcmd_size - resid;
109649ab747fSPaolo Bonzini     cmd->iov_buf = NULL;
109749ab747fSPaolo Bonzini     return MFI_STAT_OK;
109849ab747fSPaolo Bonzini }
109949ab747fSPaolo Bonzini 
110049ab747fSPaolo Bonzini static int megasas_dcmd_pd_get_info(MegasasState *s, MegasasCmd *cmd)
110149ab747fSPaolo Bonzini {
110249ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(struct mfi_pd_info);
110349ab747fSPaolo Bonzini     uint16_t pd_id;
11043f2cd4ddSHannes Reinecke     uint8_t target_id, lun_id;
110549ab747fSPaolo Bonzini     SCSIDevice *sdev = NULL;
110649ab747fSPaolo Bonzini     int retval = MFI_STAT_DEVICE_NOT_FOUND;
110749ab747fSPaolo Bonzini 
110849ab747fSPaolo Bonzini     if (cmd->iov_size < dcmd_size) {
110949ab747fSPaolo Bonzini         return MFI_STAT_INVALID_PARAMETER;
111049ab747fSPaolo Bonzini     }
111149ab747fSPaolo Bonzini 
111249ab747fSPaolo Bonzini     /* mbox0 has the ID */
111349ab747fSPaolo Bonzini     pd_id = le16_to_cpu(cmd->frame->dcmd.mbox[0]);
11143f2cd4ddSHannes Reinecke     target_id = (pd_id >> 8) & 0xFF;
11153f2cd4ddSHannes Reinecke     lun_id = pd_id & 0xFF;
11163f2cd4ddSHannes Reinecke     sdev = scsi_device_find(&s->bus, 0, target_id, lun_id);
111749ab747fSPaolo Bonzini     trace_megasas_dcmd_pd_get_info(cmd->index, pd_id);
111849ab747fSPaolo Bonzini 
111949ab747fSPaolo Bonzini     if (sdev) {
112049ab747fSPaolo Bonzini         /* Submit inquiry */
112149ab747fSPaolo Bonzini         retval = megasas_pd_get_info_submit(sdev, pd_id, cmd);
112249ab747fSPaolo Bonzini     }
112349ab747fSPaolo Bonzini 
112449ab747fSPaolo Bonzini     return retval;
112549ab747fSPaolo Bonzini }
112649ab747fSPaolo Bonzini 
112749ab747fSPaolo Bonzini static int megasas_dcmd_ld_get_list(MegasasState *s, MegasasCmd *cmd)
112849ab747fSPaolo Bonzini {
112949ab747fSPaolo Bonzini     struct mfi_ld_list info;
113049ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(info), resid;
11313f2cd4ddSHannes Reinecke     uint32_t num_ld_disks = 0, max_ld_disks;
113249ab747fSPaolo Bonzini     uint64_t ld_size;
113349ab747fSPaolo Bonzini     BusChild *kid;
113449ab747fSPaolo Bonzini 
113549ab747fSPaolo Bonzini     memset(&info, 0, dcmd_size);
1136e74a4315SHannes Reinecke     if (cmd->iov_size > dcmd_size) {
113749ab747fSPaolo Bonzini         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
113849ab747fSPaolo Bonzini                                             dcmd_size);
113949ab747fSPaolo Bonzini         return MFI_STAT_INVALID_PARAMETER;
114049ab747fSPaolo Bonzini     }
114149ab747fSPaolo Bonzini 
11423f2cd4ddSHannes Reinecke     max_ld_disks = (cmd->iov_size - 8) / 16;
114349ab747fSPaolo Bonzini     if (megasas_is_jbod(s)) {
114449ab747fSPaolo Bonzini         max_ld_disks = 0;
114549ab747fSPaolo Bonzini     }
11463f2cd4ddSHannes Reinecke     if (max_ld_disks > MFI_MAX_LD) {
11473f2cd4ddSHannes Reinecke         max_ld_disks = MFI_MAX_LD;
11483f2cd4ddSHannes Reinecke     }
114949ab747fSPaolo Bonzini     QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
1150e1dc6815SCao jin         SCSIDevice *sdev = SCSI_DEVICE(kid->child);
115149ab747fSPaolo Bonzini 
115249ab747fSPaolo Bonzini         if (num_ld_disks >= max_ld_disks) {
115349ab747fSPaolo Bonzini             break;
115449ab747fSPaolo Bonzini         }
115549ab747fSPaolo Bonzini         /* Logical device size is in blocks */
11564be74634SMarkus Armbruster         blk_get_geometry(sdev->conf.blk, &ld_size);
115749ab747fSPaolo Bonzini         info.ld_list[num_ld_disks].ld.v.target_id = sdev->id;
115849ab747fSPaolo Bonzini         info.ld_list[num_ld_disks].state = MFI_LD_STATE_OPTIMAL;
115949ab747fSPaolo Bonzini         info.ld_list[num_ld_disks].size = cpu_to_le64(ld_size);
116049ab747fSPaolo Bonzini         num_ld_disks++;
116149ab747fSPaolo Bonzini     }
116249ab747fSPaolo Bonzini     info.ld_count = cpu_to_le32(num_ld_disks);
116349ab747fSPaolo Bonzini     trace_megasas_dcmd_ld_get_list(cmd->index, num_ld_disks, max_ld_disks);
116449ab747fSPaolo Bonzini 
116549ab747fSPaolo Bonzini     resid = dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg);
116649ab747fSPaolo Bonzini     cmd->iov_size = dcmd_size - resid;
116749ab747fSPaolo Bonzini     return MFI_STAT_OK;
116849ab747fSPaolo Bonzini }
116949ab747fSPaolo Bonzini 
117034bb4d02SHannes Reinecke static int megasas_dcmd_ld_list_query(MegasasState *s, MegasasCmd *cmd)
117134bb4d02SHannes Reinecke {
117234bb4d02SHannes Reinecke     uint16_t flags;
1173d97ae368SHannes Reinecke     struct mfi_ld_targetid_list info;
1174d97ae368SHannes Reinecke     size_t dcmd_size = sizeof(info), resid;
1175d97ae368SHannes Reinecke     uint32_t num_ld_disks = 0, max_ld_disks = s->fw_luns;
1176d97ae368SHannes Reinecke     BusChild *kid;
117734bb4d02SHannes Reinecke 
117834bb4d02SHannes Reinecke     /* mbox0 contains flags */
117934bb4d02SHannes Reinecke     flags = le16_to_cpu(cmd->frame->dcmd.mbox[0]);
118034bb4d02SHannes Reinecke     trace_megasas_dcmd_ld_list_query(cmd->index, flags);
1181d97ae368SHannes Reinecke     if (flags != MR_LD_QUERY_TYPE_ALL &&
1182d97ae368SHannes Reinecke         flags != MR_LD_QUERY_TYPE_EXPOSED_TO_HOST) {
1183d97ae368SHannes Reinecke         max_ld_disks = 0;
118434bb4d02SHannes Reinecke     }
118534bb4d02SHannes Reinecke 
1186d97ae368SHannes Reinecke     memset(&info, 0, dcmd_size);
1187d97ae368SHannes Reinecke     if (cmd->iov_size < 12) {
1188d97ae368SHannes Reinecke         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
1189d97ae368SHannes Reinecke                                             dcmd_size);
1190d97ae368SHannes Reinecke         return MFI_STAT_INVALID_PARAMETER;
1191d97ae368SHannes Reinecke     }
1192d97ae368SHannes Reinecke     dcmd_size = sizeof(uint32_t) * 2 + 3;
11933f2cd4ddSHannes Reinecke     max_ld_disks = cmd->iov_size - dcmd_size;
1194d97ae368SHannes Reinecke     if (megasas_is_jbod(s)) {
1195d97ae368SHannes Reinecke         max_ld_disks = 0;
1196d97ae368SHannes Reinecke     }
11973f2cd4ddSHannes Reinecke     if (max_ld_disks > MFI_MAX_LD) {
11983f2cd4ddSHannes Reinecke         max_ld_disks = MFI_MAX_LD;
11993f2cd4ddSHannes Reinecke     }
1200d97ae368SHannes Reinecke     QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
1201e1dc6815SCao jin         SCSIDevice *sdev = SCSI_DEVICE(kid->child);
1202d97ae368SHannes Reinecke 
1203d97ae368SHannes Reinecke         if (num_ld_disks >= max_ld_disks) {
1204d97ae368SHannes Reinecke             break;
1205d97ae368SHannes Reinecke         }
1206d97ae368SHannes Reinecke         info.targetid[num_ld_disks] = sdev->lun;
1207d97ae368SHannes Reinecke         num_ld_disks++;
1208d97ae368SHannes Reinecke         dcmd_size++;
1209d97ae368SHannes Reinecke     }
1210d97ae368SHannes Reinecke     info.ld_count = cpu_to_le32(num_ld_disks);
1211d97ae368SHannes Reinecke     info.size = dcmd_size;
1212d97ae368SHannes Reinecke     trace_megasas_dcmd_ld_get_list(cmd->index, num_ld_disks, max_ld_disks);
1213d97ae368SHannes Reinecke 
1214d97ae368SHannes Reinecke     resid = dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg);
1215d97ae368SHannes Reinecke     cmd->iov_size = dcmd_size - resid;
121634bb4d02SHannes Reinecke     return MFI_STAT_OK;
121734bb4d02SHannes Reinecke }
121834bb4d02SHannes Reinecke 
121949ab747fSPaolo Bonzini static int megasas_ld_get_info_submit(SCSIDevice *sdev, int lun,
122049ab747fSPaolo Bonzini                                       MegasasCmd *cmd)
122149ab747fSPaolo Bonzini {
122249ab747fSPaolo Bonzini     struct mfi_ld_info *info = cmd->iov_buf;
122349ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(struct mfi_ld_info);
122449ab747fSPaolo Bonzini     uint8_t cdb[6];
122549ab747fSPaolo Bonzini     ssize_t len, resid;
12263f2cd4ddSHannes Reinecke     uint16_t sdev_id = ((sdev->id & 0xFF) << 8) | (lun & 0xFF);
122749ab747fSPaolo Bonzini     uint64_t ld_size;
122849ab747fSPaolo Bonzini 
122949ab747fSPaolo Bonzini     if (!cmd->iov_buf) {
12300bd0adbeSMarkus Armbruster         cmd->iov_buf = g_malloc0(dcmd_size);
123149ab747fSPaolo Bonzini         info = cmd->iov_buf;
123249ab747fSPaolo Bonzini         megasas_setup_inquiry(cdb, 0x83, sizeof(info->vpd_page83));
123387e459a8SPaolo Bonzini         cmd->req = scsi_req_new(sdev, cmd->index, lun, cdb, cmd);
123487e459a8SPaolo Bonzini         if (!cmd->req) {
123549ab747fSPaolo Bonzini             trace_megasas_dcmd_req_alloc_failed(cmd->index,
123649ab747fSPaolo Bonzini                                                 "LD get info vpd inquiry");
123749ab747fSPaolo Bonzini             g_free(cmd->iov_buf);
123849ab747fSPaolo Bonzini             cmd->iov_buf = NULL;
123949ab747fSPaolo Bonzini             return MFI_STAT_FLASH_ALLOC_FAIL;
124049ab747fSPaolo Bonzini         }
124149ab747fSPaolo Bonzini         trace_megasas_dcmd_internal_submit(cmd->index,
124249ab747fSPaolo Bonzini                                            "LD get info vpd inquiry", lun);
124387e459a8SPaolo Bonzini         len = scsi_req_enqueue(cmd->req);
124449ab747fSPaolo Bonzini         if (len > 0) {
124549ab747fSPaolo Bonzini             cmd->iov_size = len;
124687e459a8SPaolo Bonzini             scsi_req_continue(cmd->req);
124749ab747fSPaolo Bonzini         }
124849ab747fSPaolo Bonzini         return MFI_STAT_INVALID_STATUS;
124949ab747fSPaolo Bonzini     }
125049ab747fSPaolo Bonzini 
125149ab747fSPaolo Bonzini     info->ld_config.params.state = MFI_LD_STATE_OPTIMAL;
125249ab747fSPaolo Bonzini     info->ld_config.properties.ld.v.target_id = lun;
125349ab747fSPaolo Bonzini     info->ld_config.params.stripe_size = 3;
125449ab747fSPaolo Bonzini     info->ld_config.params.num_drives = 1;
125549ab747fSPaolo Bonzini     info->ld_config.params.is_consistent = 1;
125649ab747fSPaolo Bonzini     /* Logical device size is in blocks */
12574be74634SMarkus Armbruster     blk_get_geometry(sdev->conf.blk, &ld_size);
125849ab747fSPaolo Bonzini     info->size = cpu_to_le64(ld_size);
125949ab747fSPaolo Bonzini     memset(info->ld_config.span, 0, sizeof(info->ld_config.span));
126049ab747fSPaolo Bonzini     info->ld_config.span[0].start_block = 0;
126149ab747fSPaolo Bonzini     info->ld_config.span[0].num_blocks = info->size;
126249ab747fSPaolo Bonzini     info->ld_config.span[0].array_ref = cpu_to_le16(sdev_id);
126349ab747fSPaolo Bonzini 
126449ab747fSPaolo Bonzini     resid = dma_buf_read(cmd->iov_buf, dcmd_size, &cmd->qsg);
126549ab747fSPaolo Bonzini     g_free(cmd->iov_buf);
126649ab747fSPaolo Bonzini     cmd->iov_size = dcmd_size - resid;
126749ab747fSPaolo Bonzini     cmd->iov_buf = NULL;
126849ab747fSPaolo Bonzini     return MFI_STAT_OK;
126949ab747fSPaolo Bonzini }
127049ab747fSPaolo Bonzini 
127149ab747fSPaolo Bonzini static int megasas_dcmd_ld_get_info(MegasasState *s, MegasasCmd *cmd)
127249ab747fSPaolo Bonzini {
127349ab747fSPaolo Bonzini     struct mfi_ld_info info;
127449ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(info);
127549ab747fSPaolo Bonzini     uint16_t ld_id;
127649ab747fSPaolo Bonzini     uint32_t max_ld_disks = s->fw_luns;
127749ab747fSPaolo Bonzini     SCSIDevice *sdev = NULL;
127849ab747fSPaolo Bonzini     int retval = MFI_STAT_DEVICE_NOT_FOUND;
127949ab747fSPaolo Bonzini 
128049ab747fSPaolo Bonzini     if (cmd->iov_size < dcmd_size) {
128149ab747fSPaolo Bonzini         return MFI_STAT_INVALID_PARAMETER;
128249ab747fSPaolo Bonzini     }
128349ab747fSPaolo Bonzini 
128449ab747fSPaolo Bonzini     /* mbox0 has the ID */
128549ab747fSPaolo Bonzini     ld_id = le16_to_cpu(cmd->frame->dcmd.mbox[0]);
128649ab747fSPaolo Bonzini     trace_megasas_dcmd_ld_get_info(cmd->index, ld_id);
128749ab747fSPaolo Bonzini 
128849ab747fSPaolo Bonzini     if (megasas_is_jbod(s)) {
128949ab747fSPaolo Bonzini         return MFI_STAT_DEVICE_NOT_FOUND;
129049ab747fSPaolo Bonzini     }
129149ab747fSPaolo Bonzini 
129249ab747fSPaolo Bonzini     if (ld_id < max_ld_disks) {
129349ab747fSPaolo Bonzini         sdev = scsi_device_find(&s->bus, 0, ld_id, 0);
129449ab747fSPaolo Bonzini     }
129549ab747fSPaolo Bonzini 
129649ab747fSPaolo Bonzini     if (sdev) {
129749ab747fSPaolo Bonzini         retval = megasas_ld_get_info_submit(sdev, ld_id, cmd);
129849ab747fSPaolo Bonzini     }
129949ab747fSPaolo Bonzini 
130049ab747fSPaolo Bonzini     return retval;
130149ab747fSPaolo Bonzini }
130249ab747fSPaolo Bonzini 
130349ab747fSPaolo Bonzini static int megasas_dcmd_cfg_read(MegasasState *s, MegasasCmd *cmd)
130449ab747fSPaolo Bonzini {
1305d37af740SPrasad J Pandit     uint8_t data[4096] = { 0 };
130649ab747fSPaolo Bonzini     struct mfi_config_data *info;
130749ab747fSPaolo Bonzini     int num_pd_disks = 0, array_offset, ld_offset;
130849ab747fSPaolo Bonzini     BusChild *kid;
130949ab747fSPaolo Bonzini 
131049ab747fSPaolo Bonzini     if (cmd->iov_size > 4096) {
131149ab747fSPaolo Bonzini         return MFI_STAT_INVALID_PARAMETER;
131249ab747fSPaolo Bonzini     }
131349ab747fSPaolo Bonzini 
131449ab747fSPaolo Bonzini     QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
131549ab747fSPaolo Bonzini         num_pd_disks++;
131649ab747fSPaolo Bonzini     }
131749ab747fSPaolo Bonzini     info = (struct mfi_config_data *)&data;
131849ab747fSPaolo Bonzini     /*
131949ab747fSPaolo Bonzini      * Array mapping:
132049ab747fSPaolo Bonzini      * - One array per SCSI device
132149ab747fSPaolo Bonzini      * - One logical drive per SCSI device
132249ab747fSPaolo Bonzini      *   spanning the entire device
132349ab747fSPaolo Bonzini      */
132449ab747fSPaolo Bonzini     info->array_count = num_pd_disks;
132549ab747fSPaolo Bonzini     info->array_size = sizeof(struct mfi_array) * num_pd_disks;
132649ab747fSPaolo Bonzini     info->log_drv_count = num_pd_disks;
132749ab747fSPaolo Bonzini     info->log_drv_size = sizeof(struct mfi_ld_config) * num_pd_disks;
132849ab747fSPaolo Bonzini     info->spares_count = 0;
132949ab747fSPaolo Bonzini     info->spares_size = sizeof(struct mfi_spare);
133049ab747fSPaolo Bonzini     info->size = sizeof(struct mfi_config_data) + info->array_size +
133149ab747fSPaolo Bonzini         info->log_drv_size;
133249ab747fSPaolo Bonzini     if (info->size > 4096) {
133349ab747fSPaolo Bonzini         return MFI_STAT_INVALID_PARAMETER;
133449ab747fSPaolo Bonzini     }
133549ab747fSPaolo Bonzini 
133649ab747fSPaolo Bonzini     array_offset = sizeof(struct mfi_config_data);
133749ab747fSPaolo Bonzini     ld_offset = array_offset + sizeof(struct mfi_array) * num_pd_disks;
133849ab747fSPaolo Bonzini 
133949ab747fSPaolo Bonzini     QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
1340e1dc6815SCao jin         SCSIDevice *sdev = SCSI_DEVICE(kid->child);
13413f2cd4ddSHannes Reinecke         uint16_t sdev_id = ((sdev->id & 0xFF) << 8) | (sdev->lun & 0xFF);
134249ab747fSPaolo Bonzini         struct mfi_array *array;
134349ab747fSPaolo Bonzini         struct mfi_ld_config *ld;
134449ab747fSPaolo Bonzini         uint64_t pd_size;
134549ab747fSPaolo Bonzini         int i;
134649ab747fSPaolo Bonzini 
134749ab747fSPaolo Bonzini         array = (struct mfi_array *)(data + array_offset);
13484be74634SMarkus Armbruster         blk_get_geometry(sdev->conf.blk, &pd_size);
134949ab747fSPaolo Bonzini         array->size = cpu_to_le64(pd_size);
135049ab747fSPaolo Bonzini         array->num_drives = 1;
135149ab747fSPaolo Bonzini         array->array_ref = cpu_to_le16(sdev_id);
135249ab747fSPaolo Bonzini         array->pd[0].ref.v.device_id = cpu_to_le16(sdev_id);
135349ab747fSPaolo Bonzini         array->pd[0].ref.v.seq_num = 0;
135449ab747fSPaolo Bonzini         array->pd[0].fw_state = MFI_PD_STATE_ONLINE;
135549ab747fSPaolo Bonzini         array->pd[0].encl.pd = 0xFF;
135649ab747fSPaolo Bonzini         array->pd[0].encl.slot = (sdev->id & 0xFF);
135749ab747fSPaolo Bonzini         for (i = 1; i < MFI_MAX_ROW_SIZE; i++) {
135849ab747fSPaolo Bonzini             array->pd[i].ref.v.device_id = 0xFFFF;
135949ab747fSPaolo Bonzini             array->pd[i].ref.v.seq_num = 0;
136049ab747fSPaolo Bonzini             array->pd[i].fw_state = MFI_PD_STATE_UNCONFIGURED_GOOD;
136149ab747fSPaolo Bonzini             array->pd[i].encl.pd = 0xFF;
136249ab747fSPaolo Bonzini             array->pd[i].encl.slot = 0xFF;
136349ab747fSPaolo Bonzini         }
136449ab747fSPaolo Bonzini         array_offset += sizeof(struct mfi_array);
136549ab747fSPaolo Bonzini         ld = (struct mfi_ld_config *)(data + ld_offset);
136649ab747fSPaolo Bonzini         memset(ld, 0, sizeof(struct mfi_ld_config));
13673f2cd4ddSHannes Reinecke         ld->properties.ld.v.target_id = sdev->id;
136849ab747fSPaolo Bonzini         ld->properties.default_cache_policy = MR_LD_CACHE_READ_AHEAD |
136949ab747fSPaolo Bonzini             MR_LD_CACHE_READ_ADAPTIVE;
137049ab747fSPaolo Bonzini         ld->properties.current_cache_policy = MR_LD_CACHE_READ_AHEAD |
137149ab747fSPaolo Bonzini             MR_LD_CACHE_READ_ADAPTIVE;
137249ab747fSPaolo Bonzini         ld->params.state = MFI_LD_STATE_OPTIMAL;
137349ab747fSPaolo Bonzini         ld->params.stripe_size = 3;
137449ab747fSPaolo Bonzini         ld->params.num_drives = 1;
137549ab747fSPaolo Bonzini         ld->params.span_depth = 1;
137649ab747fSPaolo Bonzini         ld->params.is_consistent = 1;
137749ab747fSPaolo Bonzini         ld->span[0].start_block = 0;
137849ab747fSPaolo Bonzini         ld->span[0].num_blocks = cpu_to_le64(pd_size);
137949ab747fSPaolo Bonzini         ld->span[0].array_ref = cpu_to_le16(sdev_id);
138049ab747fSPaolo Bonzini         ld_offset += sizeof(struct mfi_ld_config);
138149ab747fSPaolo Bonzini     }
138249ab747fSPaolo Bonzini 
138349ab747fSPaolo Bonzini     cmd->iov_size -= dma_buf_read((uint8_t *)data, info->size, &cmd->qsg);
138449ab747fSPaolo Bonzini     return MFI_STAT_OK;
138549ab747fSPaolo Bonzini }
138649ab747fSPaolo Bonzini 
138749ab747fSPaolo Bonzini static int megasas_dcmd_get_properties(MegasasState *s, MegasasCmd *cmd)
138849ab747fSPaolo Bonzini {
138949ab747fSPaolo Bonzini     struct mfi_ctrl_props info;
139049ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(info);
139149ab747fSPaolo Bonzini 
139249ab747fSPaolo Bonzini     memset(&info, 0x0, dcmd_size);
139349ab747fSPaolo Bonzini     if (cmd->iov_size < dcmd_size) {
139449ab747fSPaolo Bonzini         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
139549ab747fSPaolo Bonzini                                             dcmd_size);
139649ab747fSPaolo Bonzini         return MFI_STAT_INVALID_PARAMETER;
139749ab747fSPaolo Bonzini     }
139849ab747fSPaolo Bonzini     info.pred_fail_poll_interval = cpu_to_le16(300);
139949ab747fSPaolo Bonzini     info.intr_throttle_cnt = cpu_to_le16(16);
140049ab747fSPaolo Bonzini     info.intr_throttle_timeout = cpu_to_le16(50);
140149ab747fSPaolo Bonzini     info.rebuild_rate = 30;
140249ab747fSPaolo Bonzini     info.patrol_read_rate = 30;
140349ab747fSPaolo Bonzini     info.bgi_rate = 30;
140449ab747fSPaolo Bonzini     info.cc_rate = 30;
140549ab747fSPaolo Bonzini     info.recon_rate = 30;
140649ab747fSPaolo Bonzini     info.cache_flush_interval = 4;
140749ab747fSPaolo Bonzini     info.spinup_drv_cnt = 2;
140849ab747fSPaolo Bonzini     info.spinup_delay = 6;
140949ab747fSPaolo Bonzini     info.ecc_bucket_size = 15;
141049ab747fSPaolo Bonzini     info.ecc_bucket_leak_rate = cpu_to_le16(1440);
141149ab747fSPaolo Bonzini     info.expose_encl_devices = 1;
141249ab747fSPaolo Bonzini 
141349ab747fSPaolo Bonzini     cmd->iov_size -= dma_buf_read((uint8_t *)&info, dcmd_size, &cmd->qsg);
141449ab747fSPaolo Bonzini     return MFI_STAT_OK;
141549ab747fSPaolo Bonzini }
141649ab747fSPaolo Bonzini 
141749ab747fSPaolo Bonzini static int megasas_cache_flush(MegasasState *s, MegasasCmd *cmd)
141849ab747fSPaolo Bonzini {
14194be74634SMarkus Armbruster     blk_drain_all();
142049ab747fSPaolo Bonzini     return MFI_STAT_OK;
142149ab747fSPaolo Bonzini }
142249ab747fSPaolo Bonzini 
142349ab747fSPaolo Bonzini static int megasas_ctrl_shutdown(MegasasState *s, MegasasCmd *cmd)
142449ab747fSPaolo Bonzini {
142549ab747fSPaolo Bonzini     s->fw_state = MFI_FWSTATE_READY;
142649ab747fSPaolo Bonzini     return MFI_STAT_OK;
142749ab747fSPaolo Bonzini }
142849ab747fSPaolo Bonzini 
1429200b6966SHannes Reinecke /* Some implementations use CLUSTER RESET LD to simulate a device reset */
143049ab747fSPaolo Bonzini static int megasas_cluster_reset_ld(MegasasState *s, MegasasCmd *cmd)
143149ab747fSPaolo Bonzini {
1432200b6966SHannes Reinecke     uint16_t target_id;
1433200b6966SHannes Reinecke     int i;
1434200b6966SHannes Reinecke 
1435200b6966SHannes Reinecke     /* mbox0 contains the device index */
1436200b6966SHannes Reinecke     target_id = le16_to_cpu(cmd->frame->dcmd.mbox[0]);
1437200b6966SHannes Reinecke     trace_megasas_dcmd_reset_ld(cmd->index, target_id);
1438200b6966SHannes Reinecke     for (i = 0; i < s->fw_cmds; i++) {
1439200b6966SHannes Reinecke         MegasasCmd *tmp_cmd = &s->frames[i];
1440200b6966SHannes Reinecke         if (tmp_cmd->req && tmp_cmd->req->dev->id == target_id) {
1441200b6966SHannes Reinecke             SCSIDevice *d = tmp_cmd->req->dev;
1442200b6966SHannes Reinecke             qdev_reset_all(&d->qdev);
1443200b6966SHannes Reinecke         }
1444200b6966SHannes Reinecke     }
1445200b6966SHannes Reinecke     return MFI_STAT_OK;
144649ab747fSPaolo Bonzini }
144749ab747fSPaolo Bonzini 
144849ab747fSPaolo Bonzini static int megasas_dcmd_set_properties(MegasasState *s, MegasasCmd *cmd)
144949ab747fSPaolo Bonzini {
145049ab747fSPaolo Bonzini     struct mfi_ctrl_props info;
145149ab747fSPaolo Bonzini     size_t dcmd_size = sizeof(info);
145249ab747fSPaolo Bonzini 
145349ab747fSPaolo Bonzini     if (cmd->iov_size < dcmd_size) {
145449ab747fSPaolo Bonzini         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
145549ab747fSPaolo Bonzini                                             dcmd_size);
145649ab747fSPaolo Bonzini         return MFI_STAT_INVALID_PARAMETER;
145749ab747fSPaolo Bonzini     }
14581b858980SPrasad J Pandit     dma_buf_write((uint8_t *)&info, dcmd_size, &cmd->qsg);
145949ab747fSPaolo Bonzini     trace_megasas_dcmd_unsupported(cmd->index, cmd->iov_size);
146049ab747fSPaolo Bonzini     return MFI_STAT_OK;
146149ab747fSPaolo Bonzini }
146249ab747fSPaolo Bonzini 
146349ab747fSPaolo Bonzini static int megasas_dcmd_dummy(MegasasState *s, MegasasCmd *cmd)
146449ab747fSPaolo Bonzini {
146549ab747fSPaolo Bonzini     trace_megasas_dcmd_dummy(cmd->index, cmd->iov_size);
146649ab747fSPaolo Bonzini     return MFI_STAT_OK;
146749ab747fSPaolo Bonzini }
146849ab747fSPaolo Bonzini 
146949ab747fSPaolo Bonzini static const struct dcmd_cmd_tbl_t {
147049ab747fSPaolo Bonzini     int opcode;
147149ab747fSPaolo Bonzini     const char *desc;
147249ab747fSPaolo Bonzini     int (*func)(MegasasState *s, MegasasCmd *cmd);
147349ab747fSPaolo Bonzini } dcmd_cmd_tbl[] = {
147449ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_MFI_HOST_MEM_ALLOC, "CTRL_HOST_MEM_ALLOC",
147549ab747fSPaolo Bonzini       megasas_dcmd_dummy },
147649ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_GET_INFO, "CTRL_GET_INFO",
147749ab747fSPaolo Bonzini       megasas_ctrl_get_info },
147849ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_GET_PROPERTIES, "CTRL_GET_PROPERTIES",
147949ab747fSPaolo Bonzini       megasas_dcmd_get_properties },
148049ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_SET_PROPERTIES, "CTRL_SET_PROPERTIES",
148149ab747fSPaolo Bonzini       megasas_dcmd_set_properties },
148249ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_ALARM_GET, "CTRL_ALARM_GET",
148349ab747fSPaolo Bonzini       megasas_dcmd_dummy },
148449ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_ALARM_ENABLE, "CTRL_ALARM_ENABLE",
148549ab747fSPaolo Bonzini       megasas_dcmd_dummy },
148649ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_ALARM_DISABLE, "CTRL_ALARM_DISABLE",
148749ab747fSPaolo Bonzini       megasas_dcmd_dummy },
148849ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_ALARM_SILENCE, "CTRL_ALARM_SILENCE",
148949ab747fSPaolo Bonzini       megasas_dcmd_dummy },
149049ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_ALARM_TEST, "CTRL_ALARM_TEST",
149149ab747fSPaolo Bonzini       megasas_dcmd_dummy },
149249ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_EVENT_GETINFO, "CTRL_EVENT_GETINFO",
149349ab747fSPaolo Bonzini       megasas_event_info },
149449ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_EVENT_GET, "CTRL_EVENT_GET",
149549ab747fSPaolo Bonzini       megasas_dcmd_dummy },
149649ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_EVENT_WAIT, "CTRL_EVENT_WAIT",
149749ab747fSPaolo Bonzini       megasas_event_wait },
149849ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_SHUTDOWN, "CTRL_SHUTDOWN",
149949ab747fSPaolo Bonzini       megasas_ctrl_shutdown },
150049ab747fSPaolo Bonzini     { MFI_DCMD_HIBERNATE_STANDBY, "CTRL_STANDBY",
150149ab747fSPaolo Bonzini       megasas_dcmd_dummy },
150249ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_GET_TIME, "CTRL_GET_TIME",
150349ab747fSPaolo Bonzini       megasas_dcmd_get_fw_time },
150449ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_SET_TIME, "CTRL_SET_TIME",
150549ab747fSPaolo Bonzini       megasas_dcmd_set_fw_time },
150649ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_BIOS_DATA_GET, "CTRL_BIOS_DATA_GET",
150749ab747fSPaolo Bonzini       megasas_dcmd_get_bios_info },
150849ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_FACTORY_DEFAULTS, "CTRL_FACTORY_DEFAULTS",
150949ab747fSPaolo Bonzini       megasas_dcmd_dummy },
151049ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_MFC_DEFAULTS_GET, "CTRL_MFC_DEFAULTS_GET",
151149ab747fSPaolo Bonzini       megasas_mfc_get_defaults },
151249ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_MFC_DEFAULTS_SET, "CTRL_MFC_DEFAULTS_SET",
151349ab747fSPaolo Bonzini       megasas_dcmd_dummy },
151449ab747fSPaolo Bonzini     { MFI_DCMD_CTRL_CACHE_FLUSH, "CTRL_CACHE_FLUSH",
151549ab747fSPaolo Bonzini       megasas_cache_flush },
151649ab747fSPaolo Bonzini     { MFI_DCMD_PD_GET_LIST, "PD_GET_LIST",
151749ab747fSPaolo Bonzini       megasas_dcmd_pd_get_list },
151849ab747fSPaolo Bonzini     { MFI_DCMD_PD_LIST_QUERY, "PD_LIST_QUERY",
151949ab747fSPaolo Bonzini       megasas_dcmd_pd_list_query },
152049ab747fSPaolo Bonzini     { MFI_DCMD_PD_GET_INFO, "PD_GET_INFO",
152149ab747fSPaolo Bonzini       megasas_dcmd_pd_get_info },
152249ab747fSPaolo Bonzini     { MFI_DCMD_PD_STATE_SET, "PD_STATE_SET",
152349ab747fSPaolo Bonzini       megasas_dcmd_dummy },
152449ab747fSPaolo Bonzini     { MFI_DCMD_PD_REBUILD, "PD_REBUILD",
152549ab747fSPaolo Bonzini       megasas_dcmd_dummy },
152649ab747fSPaolo Bonzini     { MFI_DCMD_PD_BLINK, "PD_BLINK",
152749ab747fSPaolo Bonzini       megasas_dcmd_dummy },
152849ab747fSPaolo Bonzini     { MFI_DCMD_PD_UNBLINK, "PD_UNBLINK",
152949ab747fSPaolo Bonzini       megasas_dcmd_dummy },
153049ab747fSPaolo Bonzini     { MFI_DCMD_LD_GET_LIST, "LD_GET_LIST",
153149ab747fSPaolo Bonzini       megasas_dcmd_ld_get_list},
153234bb4d02SHannes Reinecke     { MFI_DCMD_LD_LIST_QUERY, "LD_LIST_QUERY",
153334bb4d02SHannes Reinecke       megasas_dcmd_ld_list_query },
153449ab747fSPaolo Bonzini     { MFI_DCMD_LD_GET_INFO, "LD_GET_INFO",
153549ab747fSPaolo Bonzini       megasas_dcmd_ld_get_info },
153649ab747fSPaolo Bonzini     { MFI_DCMD_LD_GET_PROP, "LD_GET_PROP",
153749ab747fSPaolo Bonzini       megasas_dcmd_dummy },
153849ab747fSPaolo Bonzini     { MFI_DCMD_LD_SET_PROP, "LD_SET_PROP",
153949ab747fSPaolo Bonzini       megasas_dcmd_dummy },
154049ab747fSPaolo Bonzini     { MFI_DCMD_LD_DELETE, "LD_DELETE",
154149ab747fSPaolo Bonzini       megasas_dcmd_dummy },
154249ab747fSPaolo Bonzini     { MFI_DCMD_CFG_READ, "CFG_READ",
154349ab747fSPaolo Bonzini       megasas_dcmd_cfg_read },
154449ab747fSPaolo Bonzini     { MFI_DCMD_CFG_ADD, "CFG_ADD",
154549ab747fSPaolo Bonzini       megasas_dcmd_dummy },
154649ab747fSPaolo Bonzini     { MFI_DCMD_CFG_CLEAR, "CFG_CLEAR",
154749ab747fSPaolo Bonzini       megasas_dcmd_dummy },
154849ab747fSPaolo Bonzini     { MFI_DCMD_CFG_FOREIGN_READ, "CFG_FOREIGN_READ",
154949ab747fSPaolo Bonzini       megasas_dcmd_dummy },
155049ab747fSPaolo Bonzini     { MFI_DCMD_CFG_FOREIGN_IMPORT, "CFG_FOREIGN_IMPORT",
155149ab747fSPaolo Bonzini       megasas_dcmd_dummy },
155249ab747fSPaolo Bonzini     { MFI_DCMD_BBU_STATUS, "BBU_STATUS",
155349ab747fSPaolo Bonzini       megasas_dcmd_dummy },
155449ab747fSPaolo Bonzini     { MFI_DCMD_BBU_CAPACITY_INFO, "BBU_CAPACITY_INFO",
155549ab747fSPaolo Bonzini       megasas_dcmd_dummy },
155649ab747fSPaolo Bonzini     { MFI_DCMD_BBU_DESIGN_INFO, "BBU_DESIGN_INFO",
155749ab747fSPaolo Bonzini       megasas_dcmd_dummy },
155849ab747fSPaolo Bonzini     { MFI_DCMD_BBU_PROP_GET, "BBU_PROP_GET",
155949ab747fSPaolo Bonzini       megasas_dcmd_dummy },
156049ab747fSPaolo Bonzini     { MFI_DCMD_CLUSTER, "CLUSTER",
156149ab747fSPaolo Bonzini       megasas_dcmd_dummy },
156249ab747fSPaolo Bonzini     { MFI_DCMD_CLUSTER_RESET_ALL, "CLUSTER_RESET_ALL",
156349ab747fSPaolo Bonzini       megasas_dcmd_dummy },
156449ab747fSPaolo Bonzini     { MFI_DCMD_CLUSTER_RESET_LD, "CLUSTER_RESET_LD",
156549ab747fSPaolo Bonzini       megasas_cluster_reset_ld },
156649ab747fSPaolo Bonzini     { -1, NULL, NULL }
156749ab747fSPaolo Bonzini };
156849ab747fSPaolo Bonzini 
156949ab747fSPaolo Bonzini static int megasas_handle_dcmd(MegasasState *s, MegasasCmd *cmd)
157049ab747fSPaolo Bonzini {
157149ab747fSPaolo Bonzini     int retval = 0;
1572765a7070SPaolo Bonzini     size_t len;
157349ab747fSPaolo Bonzini     const struct dcmd_cmd_tbl_t *cmdptr = dcmd_cmd_tbl;
157449ab747fSPaolo Bonzini 
15755104fac8SPaolo Bonzini     cmd->dcmd_opcode = le32_to_cpu(cmd->frame->dcmd.opcode);
15765104fac8SPaolo Bonzini     trace_megasas_handle_dcmd(cmd->index, cmd->dcmd_opcode);
1577765a7070SPaolo Bonzini     if (megasas_map_dcmd(s, cmd) < 0) {
157849ab747fSPaolo Bonzini         return MFI_STAT_MEMORY_NOT_AVAILABLE;
157949ab747fSPaolo Bonzini     }
15805104fac8SPaolo Bonzini     while (cmdptr->opcode != -1 && cmdptr->opcode != cmd->dcmd_opcode) {
158149ab747fSPaolo Bonzini         cmdptr++;
158249ab747fSPaolo Bonzini     }
1583765a7070SPaolo Bonzini     len = cmd->iov_size;
158449ab747fSPaolo Bonzini     if (cmdptr->opcode == -1) {
15855104fac8SPaolo Bonzini         trace_megasas_dcmd_unhandled(cmd->index, cmd->dcmd_opcode, len);
158649ab747fSPaolo Bonzini         retval = megasas_dcmd_dummy(s, cmd);
158749ab747fSPaolo Bonzini     } else {
158849ab747fSPaolo Bonzini         trace_megasas_dcmd_enter(cmd->index, cmdptr->desc, len);
158949ab747fSPaolo Bonzini         retval = cmdptr->func(s, cmd);
159049ab747fSPaolo Bonzini     }
159149ab747fSPaolo Bonzini     if (retval != MFI_STAT_INVALID_STATUS) {
159249ab747fSPaolo Bonzini         megasas_finish_dcmd(cmd, len);
159349ab747fSPaolo Bonzini     }
159449ab747fSPaolo Bonzini     return retval;
159549ab747fSPaolo Bonzini }
159649ab747fSPaolo Bonzini 
159749ab747fSPaolo Bonzini static int megasas_finish_internal_dcmd(MegasasCmd *cmd,
159836c327a6SPaolo Bonzini                                         SCSIRequest *req, size_t resid)
159949ab747fSPaolo Bonzini {
160049ab747fSPaolo Bonzini     int retval = MFI_STAT_OK;
160149ab747fSPaolo Bonzini     int lun = req->lun;
160249ab747fSPaolo Bonzini 
16035104fac8SPaolo Bonzini     trace_megasas_dcmd_internal_finish(cmd->index, cmd->dcmd_opcode, lun);
160436c327a6SPaolo Bonzini     cmd->iov_size -= resid;
16055104fac8SPaolo Bonzini     switch (cmd->dcmd_opcode) {
160649ab747fSPaolo Bonzini     case MFI_DCMD_PD_GET_INFO:
160749ab747fSPaolo Bonzini         retval = megasas_pd_get_info_submit(req->dev, lun, cmd);
160849ab747fSPaolo Bonzini         break;
160949ab747fSPaolo Bonzini     case MFI_DCMD_LD_GET_INFO:
161049ab747fSPaolo Bonzini         retval = megasas_ld_get_info_submit(req->dev, lun, cmd);
161149ab747fSPaolo Bonzini         break;
161249ab747fSPaolo Bonzini     default:
16135104fac8SPaolo Bonzini         trace_megasas_dcmd_internal_invalid(cmd->index, cmd->dcmd_opcode);
161449ab747fSPaolo Bonzini         retval = MFI_STAT_INVALID_DCMD;
161549ab747fSPaolo Bonzini         break;
161649ab747fSPaolo Bonzini     }
161749ab747fSPaolo Bonzini     if (retval != MFI_STAT_INVALID_STATUS) {
161849ab747fSPaolo Bonzini         megasas_finish_dcmd(cmd, cmd->iov_size);
161949ab747fSPaolo Bonzini     }
162049ab747fSPaolo Bonzini     return retval;
162149ab747fSPaolo Bonzini }
162249ab747fSPaolo Bonzini 
162349ab747fSPaolo Bonzini static int megasas_enqueue_req(MegasasCmd *cmd, bool is_write)
162449ab747fSPaolo Bonzini {
162549ab747fSPaolo Bonzini     int len;
162649ab747fSPaolo Bonzini 
162749ab747fSPaolo Bonzini     len = scsi_req_enqueue(cmd->req);
162849ab747fSPaolo Bonzini     if (len < 0) {
162949ab747fSPaolo Bonzini         len = -len;
163049ab747fSPaolo Bonzini     }
163149ab747fSPaolo Bonzini     if (len > 0) {
163249ab747fSPaolo Bonzini         if (len > cmd->iov_size) {
163349ab747fSPaolo Bonzini             if (is_write) {
163449ab747fSPaolo Bonzini                 trace_megasas_iov_write_overflow(cmd->index, len,
163549ab747fSPaolo Bonzini                                                  cmd->iov_size);
163649ab747fSPaolo Bonzini             } else {
163749ab747fSPaolo Bonzini                 trace_megasas_iov_read_overflow(cmd->index, len,
163849ab747fSPaolo Bonzini                                                 cmd->iov_size);
163949ab747fSPaolo Bonzini             }
164049ab747fSPaolo Bonzini         }
164149ab747fSPaolo Bonzini         if (len < cmd->iov_size) {
164249ab747fSPaolo Bonzini             if (is_write) {
164349ab747fSPaolo Bonzini                 trace_megasas_iov_write_underflow(cmd->index, len,
164449ab747fSPaolo Bonzini                                                   cmd->iov_size);
164549ab747fSPaolo Bonzini             } else {
164649ab747fSPaolo Bonzini                 trace_megasas_iov_read_underflow(cmd->index, len,
164749ab747fSPaolo Bonzini                                                  cmd->iov_size);
164849ab747fSPaolo Bonzini             }
164949ab747fSPaolo Bonzini             cmd->iov_size = len;
165049ab747fSPaolo Bonzini         }
165149ab747fSPaolo Bonzini         scsi_req_continue(cmd->req);
165249ab747fSPaolo Bonzini     }
165349ab747fSPaolo Bonzini     return len;
165449ab747fSPaolo Bonzini }
165549ab747fSPaolo Bonzini 
165649ab747fSPaolo Bonzini static int megasas_handle_scsi(MegasasState *s, MegasasCmd *cmd,
165736c327a6SPaolo Bonzini                                int frame_cmd)
165849ab747fSPaolo Bonzini {
165949ab747fSPaolo Bonzini     uint8_t *cdb;
1660b356807fSPaolo Bonzini     int target_id, lun_id, cdb_len;
166149ab747fSPaolo Bonzini     bool is_write;
166249ab747fSPaolo Bonzini     struct SCSIDevice *sdev = NULL;
166336c327a6SPaolo Bonzini     bool is_logical = (frame_cmd == MFI_CMD_LD_SCSI_IO);
166449ab747fSPaolo Bonzini 
166549ab747fSPaolo Bonzini     cdb = cmd->frame->pass.cdb;
1666b356807fSPaolo Bonzini     target_id = cmd->frame->header.target_id;
1667b356807fSPaolo Bonzini     lun_id = cmd->frame->header.lun_id;
1668b356807fSPaolo Bonzini     cdb_len = cmd->frame->header.cdb_len;
166949ab747fSPaolo Bonzini 
16703f2cd4ddSHannes Reinecke     if (is_logical) {
1671b356807fSPaolo Bonzini         if (target_id >= MFI_MAX_LD || lun_id != 0) {
16723f2cd4ddSHannes Reinecke             trace_megasas_scsi_target_not_present(
1673b356807fSPaolo Bonzini                 mfi_frame_desc[frame_cmd], is_logical, target_id, lun_id);
16743f2cd4ddSHannes Reinecke             return MFI_STAT_DEVICE_NOT_FOUND;
16753f2cd4ddSHannes Reinecke         }
16763f2cd4ddSHannes Reinecke     }
1677b356807fSPaolo Bonzini     sdev = scsi_device_find(&s->bus, 0, target_id, lun_id);
16783f2cd4ddSHannes Reinecke 
167949ab747fSPaolo Bonzini     cmd->iov_size = le32_to_cpu(cmd->frame->header.data_len);
168036c327a6SPaolo Bonzini     trace_megasas_handle_scsi(mfi_frame_desc[frame_cmd], is_logical,
1681b356807fSPaolo Bonzini                               target_id, lun_id, sdev, cmd->iov_size);
168249ab747fSPaolo Bonzini 
168349ab747fSPaolo Bonzini     if (!sdev || (megasas_is_jbod(s) && is_logical)) {
168449ab747fSPaolo Bonzini         trace_megasas_scsi_target_not_present(
1685b356807fSPaolo Bonzini             mfi_frame_desc[frame_cmd], is_logical, target_id, lun_id);
168649ab747fSPaolo Bonzini         return MFI_STAT_DEVICE_NOT_FOUND;
168749ab747fSPaolo Bonzini     }
168849ab747fSPaolo Bonzini 
1689b356807fSPaolo Bonzini     if (cdb_len > 16) {
169049ab747fSPaolo Bonzini         trace_megasas_scsi_invalid_cdb_len(
169136c327a6SPaolo Bonzini                 mfi_frame_desc[frame_cmd], is_logical,
1692b356807fSPaolo Bonzini                 target_id, lun_id, cdb_len);
169349ab747fSPaolo Bonzini         megasas_write_sense(cmd, SENSE_CODE(INVALID_OPCODE));
169449ab747fSPaolo Bonzini         cmd->frame->header.scsi_status = CHECK_CONDITION;
169549ab747fSPaolo Bonzini         s->event_count++;
169649ab747fSPaolo Bonzini         return MFI_STAT_SCSI_DONE_WITH_ERROR;
169749ab747fSPaolo Bonzini     }
169849ab747fSPaolo Bonzini 
169949ab747fSPaolo Bonzini     if (megasas_map_sgl(s, cmd, &cmd->frame->pass.sgl)) {
170049ab747fSPaolo Bonzini         megasas_write_sense(cmd, SENSE_CODE(TARGET_FAILURE));
170149ab747fSPaolo Bonzini         cmd->frame->header.scsi_status = CHECK_CONDITION;
170249ab747fSPaolo Bonzini         s->event_count++;
170349ab747fSPaolo Bonzini         return MFI_STAT_SCSI_DONE_WITH_ERROR;
170449ab747fSPaolo Bonzini     }
170549ab747fSPaolo Bonzini 
1706b356807fSPaolo Bonzini     cmd->req = scsi_req_new(sdev, cmd->index, lun_id, cdb, cmd);
170749ab747fSPaolo Bonzini     if (!cmd->req) {
170849ab747fSPaolo Bonzini         trace_megasas_scsi_req_alloc_failed(
1709b356807fSPaolo Bonzini                 mfi_frame_desc[frame_cmd], target_id, lun_id);
171049ab747fSPaolo Bonzini         megasas_write_sense(cmd, SENSE_CODE(NO_SENSE));
171149ab747fSPaolo Bonzini         cmd->frame->header.scsi_status = BUSY;
171249ab747fSPaolo Bonzini         s->event_count++;
171349ab747fSPaolo Bonzini         return MFI_STAT_SCSI_DONE_WITH_ERROR;
171449ab747fSPaolo Bonzini     }
171549ab747fSPaolo Bonzini 
171649ab747fSPaolo Bonzini     is_write = (cmd->req->cmd.mode == SCSI_XFER_TO_DEV);
1717aaf2a859SHannes Reinecke     if (cmd->iov_size) {
171849ab747fSPaolo Bonzini         if (is_write) {
1719aaf2a859SHannes Reinecke             trace_megasas_scsi_write_start(cmd->index, cmd->iov_size);
172049ab747fSPaolo Bonzini         } else {
1721aaf2a859SHannes Reinecke             trace_megasas_scsi_read_start(cmd->index, cmd->iov_size);
172249ab747fSPaolo Bonzini         }
172349ab747fSPaolo Bonzini     } else {
172449ab747fSPaolo Bonzini         trace_megasas_scsi_nodata(cmd->index);
172549ab747fSPaolo Bonzini     }
1726aaf2a859SHannes Reinecke     megasas_enqueue_req(cmd, is_write);
172749ab747fSPaolo Bonzini     return MFI_STAT_INVALID_STATUS;
172849ab747fSPaolo Bonzini }
172949ab747fSPaolo Bonzini 
173036c327a6SPaolo Bonzini static int megasas_handle_io(MegasasState *s, MegasasCmd *cmd, int frame_cmd)
173149ab747fSPaolo Bonzini {
173249ab747fSPaolo Bonzini     uint32_t lba_count, lba_start_hi, lba_start_lo;
173349ab747fSPaolo Bonzini     uint64_t lba_start;
173436c327a6SPaolo Bonzini     bool is_write = (frame_cmd == MFI_CMD_LD_WRITE);
173549ab747fSPaolo Bonzini     uint8_t cdb[16];
173649ab747fSPaolo Bonzini     int len;
173749ab747fSPaolo Bonzini     struct SCSIDevice *sdev = NULL;
1738b356807fSPaolo Bonzini     int target_id, lun_id, cdb_len;
173949ab747fSPaolo Bonzini 
174049ab747fSPaolo Bonzini     lba_count = le32_to_cpu(cmd->frame->io.header.data_len);
174149ab747fSPaolo Bonzini     lba_start_lo = le32_to_cpu(cmd->frame->io.lba_lo);
174249ab747fSPaolo Bonzini     lba_start_hi = le32_to_cpu(cmd->frame->io.lba_hi);
174349ab747fSPaolo Bonzini     lba_start = ((uint64_t)lba_start_hi << 32) | lba_start_lo;
174449ab747fSPaolo Bonzini 
1745b356807fSPaolo Bonzini     target_id = cmd->frame->header.target_id;
1746b356807fSPaolo Bonzini     lun_id = cmd->frame->header.lun_id;
1747b356807fSPaolo Bonzini     cdb_len = cmd->frame->header.cdb_len;
1748b356807fSPaolo Bonzini 
1749b356807fSPaolo Bonzini     if (target_id < MFI_MAX_LD && lun_id == 0) {
1750b356807fSPaolo Bonzini         sdev = scsi_device_find(&s->bus, 0, target_id, lun_id);
175149ab747fSPaolo Bonzini     }
175249ab747fSPaolo Bonzini 
175349ab747fSPaolo Bonzini     trace_megasas_handle_io(cmd->index,
1754b356807fSPaolo Bonzini                             mfi_frame_desc[frame_cmd], target_id, lun_id,
175549ab747fSPaolo Bonzini                             (unsigned long)lba_start, (unsigned long)lba_count);
175649ab747fSPaolo Bonzini     if (!sdev) {
175749ab747fSPaolo Bonzini         trace_megasas_io_target_not_present(cmd->index,
1758b356807fSPaolo Bonzini             mfi_frame_desc[frame_cmd], target_id, lun_id);
175949ab747fSPaolo Bonzini         return MFI_STAT_DEVICE_NOT_FOUND;
176049ab747fSPaolo Bonzini     }
176149ab747fSPaolo Bonzini 
1762b356807fSPaolo Bonzini     if (cdb_len > 16) {
176349ab747fSPaolo Bonzini         trace_megasas_scsi_invalid_cdb_len(
1764b356807fSPaolo Bonzini             mfi_frame_desc[frame_cmd], 1, target_id, lun_id, cdb_len);
176549ab747fSPaolo Bonzini         megasas_write_sense(cmd, SENSE_CODE(INVALID_OPCODE));
176649ab747fSPaolo Bonzini         cmd->frame->header.scsi_status = CHECK_CONDITION;
176749ab747fSPaolo Bonzini         s->event_count++;
176849ab747fSPaolo Bonzini         return MFI_STAT_SCSI_DONE_WITH_ERROR;
176949ab747fSPaolo Bonzini     }
177049ab747fSPaolo Bonzini 
177149ab747fSPaolo Bonzini     cmd->iov_size = lba_count * sdev->blocksize;
177249ab747fSPaolo Bonzini     if (megasas_map_sgl(s, cmd, &cmd->frame->io.sgl)) {
177349ab747fSPaolo Bonzini         megasas_write_sense(cmd, SENSE_CODE(TARGET_FAILURE));
177449ab747fSPaolo Bonzini         cmd->frame->header.scsi_status = CHECK_CONDITION;
177549ab747fSPaolo Bonzini         s->event_count++;
177649ab747fSPaolo Bonzini         return MFI_STAT_SCSI_DONE_WITH_ERROR;
177749ab747fSPaolo Bonzini     }
177849ab747fSPaolo Bonzini 
177949ab747fSPaolo Bonzini     megasas_encode_lba(cdb, lba_start, lba_count, is_write);
178049ab747fSPaolo Bonzini     cmd->req = scsi_req_new(sdev, cmd->index,
1781b356807fSPaolo Bonzini                             lun_id, cdb, cmd);
178249ab747fSPaolo Bonzini     if (!cmd->req) {
178349ab747fSPaolo Bonzini         trace_megasas_scsi_req_alloc_failed(
1784b356807fSPaolo Bonzini             mfi_frame_desc[frame_cmd], target_id, lun_id);
178549ab747fSPaolo Bonzini         megasas_write_sense(cmd, SENSE_CODE(NO_SENSE));
178649ab747fSPaolo Bonzini         cmd->frame->header.scsi_status = BUSY;
178749ab747fSPaolo Bonzini         s->event_count++;
178849ab747fSPaolo Bonzini         return MFI_STAT_SCSI_DONE_WITH_ERROR;
178949ab747fSPaolo Bonzini     }
179049ab747fSPaolo Bonzini     len = megasas_enqueue_req(cmd, is_write);
179149ab747fSPaolo Bonzini     if (len > 0) {
179249ab747fSPaolo Bonzini         if (is_write) {
179349ab747fSPaolo Bonzini             trace_megasas_io_write_start(cmd->index, lba_start, lba_count, len);
179449ab747fSPaolo Bonzini         } else {
179549ab747fSPaolo Bonzini             trace_megasas_io_read_start(cmd->index, lba_start, lba_count, len);
179649ab747fSPaolo Bonzini         }
179749ab747fSPaolo Bonzini     }
179849ab747fSPaolo Bonzini     return MFI_STAT_INVALID_STATUS;
179949ab747fSPaolo Bonzini }
180049ab747fSPaolo Bonzini 
180149ab747fSPaolo Bonzini static QEMUSGList *megasas_get_sg_list(SCSIRequest *req)
180249ab747fSPaolo Bonzini {
180349ab747fSPaolo Bonzini     MegasasCmd *cmd = req->hba_private;
180449ab747fSPaolo Bonzini 
180536c327a6SPaolo Bonzini     if (cmd->dcmd_opcode != -1) {
180649ab747fSPaolo Bonzini         return NULL;
180749ab747fSPaolo Bonzini     } else {
180849ab747fSPaolo Bonzini         return &cmd->qsg;
180949ab747fSPaolo Bonzini     }
181049ab747fSPaolo Bonzini }
181149ab747fSPaolo Bonzini 
181249ab747fSPaolo Bonzini static void megasas_xfer_complete(SCSIRequest *req, uint32_t len)
181349ab747fSPaolo Bonzini {
181449ab747fSPaolo Bonzini     MegasasCmd *cmd = req->hba_private;
181549ab747fSPaolo Bonzini     uint8_t *buf;
181649ab747fSPaolo Bonzini 
181749ab747fSPaolo Bonzini     trace_megasas_io_complete(cmd->index, len);
181849ab747fSPaolo Bonzini 
181936c327a6SPaolo Bonzini     if (cmd->dcmd_opcode != -1) {
182049ab747fSPaolo Bonzini         scsi_req_continue(req);
182149ab747fSPaolo Bonzini         return;
182249ab747fSPaolo Bonzini     }
182349ab747fSPaolo Bonzini 
182449ab747fSPaolo Bonzini     buf = scsi_req_get_buf(req);
18255104fac8SPaolo Bonzini     if (cmd->dcmd_opcode == MFI_DCMD_PD_GET_INFO && cmd->iov_buf) {
182649ab747fSPaolo Bonzini         struct mfi_pd_info *info = cmd->iov_buf;
182749ab747fSPaolo Bonzini 
182849ab747fSPaolo Bonzini         if (info->inquiry_data[0] == 0x7f) {
182949ab747fSPaolo Bonzini             memset(info->inquiry_data, 0, sizeof(info->inquiry_data));
183049ab747fSPaolo Bonzini             memcpy(info->inquiry_data, buf, len);
183149ab747fSPaolo Bonzini         } else if (info->vpd_page83[0] == 0x7f) {
183249ab747fSPaolo Bonzini             memset(info->vpd_page83, 0, sizeof(info->vpd_page83));
183349ab747fSPaolo Bonzini             memcpy(info->vpd_page83, buf, len);
183449ab747fSPaolo Bonzini         }
183549ab747fSPaolo Bonzini         scsi_req_continue(req);
18365104fac8SPaolo Bonzini     } else if (cmd->dcmd_opcode == MFI_DCMD_LD_GET_INFO) {
183749ab747fSPaolo Bonzini         struct mfi_ld_info *info = cmd->iov_buf;
183849ab747fSPaolo Bonzini 
183949ab747fSPaolo Bonzini         if (cmd->iov_buf) {
184049ab747fSPaolo Bonzini             memcpy(info->vpd_page83, buf, sizeof(info->vpd_page83));
184149ab747fSPaolo Bonzini             scsi_req_continue(req);
184249ab747fSPaolo Bonzini         }
184349ab747fSPaolo Bonzini     }
184449ab747fSPaolo Bonzini }
184549ab747fSPaolo Bonzini 
184649ab747fSPaolo Bonzini static void megasas_command_complete(SCSIRequest *req, uint32_t status,
184749ab747fSPaolo Bonzini                                      size_t resid)
184849ab747fSPaolo Bonzini {
184949ab747fSPaolo Bonzini     MegasasCmd *cmd = req->hba_private;
185049ab747fSPaolo Bonzini     uint8_t cmd_status = MFI_STAT_OK;
185149ab747fSPaolo Bonzini 
185249ab747fSPaolo Bonzini     trace_megasas_command_complete(cmd->index, status, resid);
185349ab747fSPaolo Bonzini 
18549e55d588SPaolo Bonzini     if (req->io_canceled) {
18559e55d588SPaolo Bonzini         return;
18569e55d588SPaolo Bonzini     }
18579e55d588SPaolo Bonzini 
185887e459a8SPaolo Bonzini     if (cmd->dcmd_opcode != -1) {
185949ab747fSPaolo Bonzini         /*
186049ab747fSPaolo Bonzini          * Internal command complete
186149ab747fSPaolo Bonzini          */
186236c327a6SPaolo Bonzini         cmd_status = megasas_finish_internal_dcmd(cmd, req, resid);
186349ab747fSPaolo Bonzini         if (cmd_status == MFI_STAT_INVALID_STATUS) {
186449ab747fSPaolo Bonzini             return;
186549ab747fSPaolo Bonzini         }
186649ab747fSPaolo Bonzini     } else {
186749ab747fSPaolo Bonzini         req->status = status;
186849ab747fSPaolo Bonzini         trace_megasas_scsi_complete(cmd->index, req->status,
186949ab747fSPaolo Bonzini                                     cmd->iov_size, req->cmd.xfer);
187049ab747fSPaolo Bonzini         if (req->status != GOOD) {
187149ab747fSPaolo Bonzini             cmd_status = MFI_STAT_SCSI_DONE_WITH_ERROR;
187249ab747fSPaolo Bonzini         }
187349ab747fSPaolo Bonzini         if (req->status == CHECK_CONDITION) {
187449ab747fSPaolo Bonzini             megasas_copy_sense(cmd);
187549ab747fSPaolo Bonzini         }
187649ab747fSPaolo Bonzini 
187749ab747fSPaolo Bonzini         cmd->frame->header.scsi_status = req->status;
187849ab747fSPaolo Bonzini     }
187949ab747fSPaolo Bonzini     cmd->frame->header.cmd_status = cmd_status;
18809e55d588SPaolo Bonzini     megasas_complete_command(cmd);
188149ab747fSPaolo Bonzini }
188249ab747fSPaolo Bonzini 
18839e55d588SPaolo Bonzini static void megasas_command_cancelled(SCSIRequest *req)
188449ab747fSPaolo Bonzini {
188549ab747fSPaolo Bonzini     MegasasCmd *cmd = req->hba_private;
188649ab747fSPaolo Bonzini 
18879e55d588SPaolo Bonzini     if (!cmd) {
18889e55d588SPaolo Bonzini         return;
188949ab747fSPaolo Bonzini     }
18909e55d588SPaolo Bonzini     cmd->frame->header.cmd_status = MFI_STAT_SCSI_IO_FAILED;
18919e55d588SPaolo Bonzini     megasas_complete_command(cmd);
189249ab747fSPaolo Bonzini }
189349ab747fSPaolo Bonzini 
189449ab747fSPaolo Bonzini static int megasas_handle_abort(MegasasState *s, MegasasCmd *cmd)
189549ab747fSPaolo Bonzini {
189649ab747fSPaolo Bonzini     uint64_t abort_ctx = le64_to_cpu(cmd->frame->abort.abort_context);
189749ab747fSPaolo Bonzini     hwaddr abort_addr, addr_hi, addr_lo;
189849ab747fSPaolo Bonzini     MegasasCmd *abort_cmd;
189949ab747fSPaolo Bonzini 
190049ab747fSPaolo Bonzini     addr_hi = le32_to_cpu(cmd->frame->abort.abort_mfi_addr_hi);
190149ab747fSPaolo Bonzini     addr_lo = le32_to_cpu(cmd->frame->abort.abort_mfi_addr_lo);
190249ab747fSPaolo Bonzini     abort_addr = ((uint64_t)addr_hi << 32) | addr_lo;
190349ab747fSPaolo Bonzini 
190449ab747fSPaolo Bonzini     abort_cmd = megasas_lookup_frame(s, abort_addr);
190549ab747fSPaolo Bonzini     if (!abort_cmd) {
190649ab747fSPaolo Bonzini         trace_megasas_abort_no_cmd(cmd->index, abort_ctx);
190749ab747fSPaolo Bonzini         s->event_count++;
190849ab747fSPaolo Bonzini         return MFI_STAT_OK;
190949ab747fSPaolo Bonzini     }
191049ab747fSPaolo Bonzini     if (!megasas_use_queue64(s)) {
191149ab747fSPaolo Bonzini         abort_ctx &= (uint64_t)0xFFFFFFFF;
191249ab747fSPaolo Bonzini     }
191349ab747fSPaolo Bonzini     if (abort_cmd->context != abort_ctx) {
1914d17e7448SEric Blake         trace_megasas_abort_invalid_context(cmd->index, abort_cmd->context,
1915d17e7448SEric Blake                                             abort_cmd->index);
191649ab747fSPaolo Bonzini         s->event_count++;
191749ab747fSPaolo Bonzini         return MFI_STAT_ABORT_NOT_POSSIBLE;
191849ab747fSPaolo Bonzini     }
191949ab747fSPaolo Bonzini     trace_megasas_abort_frame(cmd->index, abort_cmd->index);
192049ab747fSPaolo Bonzini     megasas_abort_command(abort_cmd);
192149ab747fSPaolo Bonzini     if (!s->event_cmd || abort_cmd != s->event_cmd) {
192249ab747fSPaolo Bonzini         s->event_cmd = NULL;
192349ab747fSPaolo Bonzini     }
192449ab747fSPaolo Bonzini     s->event_count++;
192549ab747fSPaolo Bonzini     return MFI_STAT_OK;
192649ab747fSPaolo Bonzini }
192749ab747fSPaolo Bonzini 
192849ab747fSPaolo Bonzini static void megasas_handle_frame(MegasasState *s, uint64_t frame_addr,
192949ab747fSPaolo Bonzini                                  uint32_t frame_count)
193049ab747fSPaolo Bonzini {
193149ab747fSPaolo Bonzini     uint8_t frame_status = MFI_STAT_INVALID_CMD;
193249ab747fSPaolo Bonzini     uint64_t frame_context;
193336c327a6SPaolo Bonzini     int frame_cmd;
193449ab747fSPaolo Bonzini     MegasasCmd *cmd;
193549ab747fSPaolo Bonzini 
193649ab747fSPaolo Bonzini     /*
193749ab747fSPaolo Bonzini      * Always read 64bit context, top bits will be
193849ab747fSPaolo Bonzini      * masked out if required in megasas_enqueue_frame()
193949ab747fSPaolo Bonzini      */
194016578c6fSPaolo Bonzini     frame_context = megasas_frame_get_context(s, frame_addr);
194149ab747fSPaolo Bonzini 
194249ab747fSPaolo Bonzini     cmd = megasas_enqueue_frame(s, frame_addr, frame_context, frame_count);
194349ab747fSPaolo Bonzini     if (!cmd) {
194449ab747fSPaolo Bonzini         /* reply queue full */
194549ab747fSPaolo Bonzini         trace_megasas_frame_busy(frame_addr);
194616578c6fSPaolo Bonzini         megasas_frame_set_scsi_status(s, frame_addr, BUSY);
194716578c6fSPaolo Bonzini         megasas_frame_set_cmd_status(s, frame_addr, MFI_STAT_SCSI_DONE_WITH_ERROR);
194849ab747fSPaolo Bonzini         megasas_complete_frame(s, frame_context);
194949ab747fSPaolo Bonzini         s->event_count++;
195049ab747fSPaolo Bonzini         return;
195149ab747fSPaolo Bonzini     }
195236c327a6SPaolo Bonzini     frame_cmd = cmd->frame->header.frame_cmd;
195336c327a6SPaolo Bonzini     switch (frame_cmd) {
195449ab747fSPaolo Bonzini     case MFI_CMD_INIT:
195549ab747fSPaolo Bonzini         frame_status = megasas_init_firmware(s, cmd);
195649ab747fSPaolo Bonzini         break;
195749ab747fSPaolo Bonzini     case MFI_CMD_DCMD:
195849ab747fSPaolo Bonzini         frame_status = megasas_handle_dcmd(s, cmd);
195949ab747fSPaolo Bonzini         break;
196049ab747fSPaolo Bonzini     case MFI_CMD_ABORT:
196149ab747fSPaolo Bonzini         frame_status = megasas_handle_abort(s, cmd);
196249ab747fSPaolo Bonzini         break;
196349ab747fSPaolo Bonzini     case MFI_CMD_PD_SCSI_IO:
196449ab747fSPaolo Bonzini     case MFI_CMD_LD_SCSI_IO:
196536c327a6SPaolo Bonzini         frame_status = megasas_handle_scsi(s, cmd, frame_cmd);
196649ab747fSPaolo Bonzini         break;
196749ab747fSPaolo Bonzini     case MFI_CMD_LD_READ:
196849ab747fSPaolo Bonzini     case MFI_CMD_LD_WRITE:
196936c327a6SPaolo Bonzini         frame_status = megasas_handle_io(s, cmd, frame_cmd);
197049ab747fSPaolo Bonzini         break;
197149ab747fSPaolo Bonzini     default:
197236c327a6SPaolo Bonzini         trace_megasas_unhandled_frame_cmd(cmd->index, frame_cmd);
197349ab747fSPaolo Bonzini         s->event_count++;
197449ab747fSPaolo Bonzini         break;
197549ab747fSPaolo Bonzini     }
197649ab747fSPaolo Bonzini     if (frame_status != MFI_STAT_INVALID_STATUS) {
1977421cc3e7SPaolo Bonzini         if (cmd->frame) {
197849ab747fSPaolo Bonzini             cmd->frame->header.cmd_status = frame_status;
1979421cc3e7SPaolo Bonzini         } else {
1980421cc3e7SPaolo Bonzini             megasas_frame_set_cmd_status(s, frame_addr, frame_status);
1981421cc3e7SPaolo Bonzini         }
19826df5718bSHannes Reinecke         megasas_unmap_frame(s, cmd);
198349ab747fSPaolo Bonzini         megasas_complete_frame(s, cmd->context);
198449ab747fSPaolo Bonzini     }
198549ab747fSPaolo Bonzini }
198649ab747fSPaolo Bonzini 
198749ab747fSPaolo Bonzini static uint64_t megasas_mmio_read(void *opaque, hwaddr addr,
198849ab747fSPaolo Bonzini                                   unsigned size)
198949ab747fSPaolo Bonzini {
199049ab747fSPaolo Bonzini     MegasasState *s = opaque;
1991e23d0498SHannes Reinecke     PCIDevice *pci_dev = PCI_DEVICE(s);
1992e23d0498SHannes Reinecke     MegasasBaseClass *base_class = MEGASAS_DEVICE_GET_CLASS(s);
199349ab747fSPaolo Bonzini     uint32_t retval = 0;
199449ab747fSPaolo Bonzini 
199549ab747fSPaolo Bonzini     switch (addr) {
199649ab747fSPaolo Bonzini     case MFI_IDB:
199749ab747fSPaolo Bonzini         retval = 0;
199877bb6b17SHannes Reinecke         trace_megasas_mmio_readl("MFI_IDB", retval);
199949ab747fSPaolo Bonzini         break;
200049ab747fSPaolo Bonzini     case MFI_OMSG0:
200149ab747fSPaolo Bonzini     case MFI_OSP0:
2002e23d0498SHannes Reinecke         retval = (msix_present(pci_dev) ? MFI_FWSTATE_MSIX_SUPPORTED : 0) |
200349ab747fSPaolo Bonzini             (s->fw_state & MFI_FWSTATE_MASK) |
200449ab747fSPaolo Bonzini             ((s->fw_sge & 0xff) << 16) |
200549ab747fSPaolo Bonzini             (s->fw_cmds & 0xFFFF);
200677bb6b17SHannes Reinecke         trace_megasas_mmio_readl(addr == MFI_OMSG0 ? "MFI_OMSG0" : "MFI_OSP0",
200777bb6b17SHannes Reinecke                                  retval);
200849ab747fSPaolo Bonzini         break;
200949ab747fSPaolo Bonzini     case MFI_OSTS:
201049ab747fSPaolo Bonzini         if (megasas_intr_enabled(s) && s->doorbell) {
2011e23d0498SHannes Reinecke             retval = base_class->osts;
201249ab747fSPaolo Bonzini         }
201377bb6b17SHannes Reinecke         trace_megasas_mmio_readl("MFI_OSTS", retval);
201449ab747fSPaolo Bonzini         break;
201549ab747fSPaolo Bonzini     case MFI_OMSK:
201649ab747fSPaolo Bonzini         retval = s->intr_mask;
201777bb6b17SHannes Reinecke         trace_megasas_mmio_readl("MFI_OMSK", retval);
201849ab747fSPaolo Bonzini         break;
201949ab747fSPaolo Bonzini     case MFI_ODCR0:
20207957ee71SHannes Reinecke         retval = s->doorbell ? 1 : 0;
202177bb6b17SHannes Reinecke         trace_megasas_mmio_readl("MFI_ODCR0", retval);
202249ab747fSPaolo Bonzini         break;
2023e23d0498SHannes Reinecke     case MFI_DIAG:
2024e23d0498SHannes Reinecke         retval = s->diag;
202577bb6b17SHannes Reinecke         trace_megasas_mmio_readl("MFI_DIAG", retval);
2026e23d0498SHannes Reinecke         break;
2027e23d0498SHannes Reinecke     case MFI_OSP1:
2028e23d0498SHannes Reinecke         retval = 15;
202977bb6b17SHannes Reinecke         trace_megasas_mmio_readl("MFI_OSP1", retval);
2030e23d0498SHannes Reinecke         break;
203149ab747fSPaolo Bonzini     default:
203249ab747fSPaolo Bonzini         trace_megasas_mmio_invalid_readl(addr);
203349ab747fSPaolo Bonzini         break;
203449ab747fSPaolo Bonzini     }
203549ab747fSPaolo Bonzini     return retval;
203649ab747fSPaolo Bonzini }
203749ab747fSPaolo Bonzini 
2038e23d0498SHannes Reinecke static int adp_reset_seq[] = {0x00, 0x04, 0x0b, 0x02, 0x07, 0x0d};
2039e23d0498SHannes Reinecke 
204049ab747fSPaolo Bonzini static void megasas_mmio_write(void *opaque, hwaddr addr,
204149ab747fSPaolo Bonzini                                uint64_t val, unsigned size)
204249ab747fSPaolo Bonzini {
204349ab747fSPaolo Bonzini     MegasasState *s = opaque;
204452190c1eSAndreas Färber     PCIDevice *pci_dev = PCI_DEVICE(s);
204549ab747fSPaolo Bonzini     uint64_t frame_addr;
204649ab747fSPaolo Bonzini     uint32_t frame_count;
204749ab747fSPaolo Bonzini     int i;
204849ab747fSPaolo Bonzini 
204949ab747fSPaolo Bonzini     switch (addr) {
205049ab747fSPaolo Bonzini     case MFI_IDB:
205177bb6b17SHannes Reinecke         trace_megasas_mmio_writel("MFI_IDB", val);
205249ab747fSPaolo Bonzini         if (val & MFI_FWINIT_ABORT) {
205349ab747fSPaolo Bonzini             /* Abort all pending cmds */
205449ab747fSPaolo Bonzini             for (i = 0; i < s->fw_cmds; i++) {
205549ab747fSPaolo Bonzini                 megasas_abort_command(&s->frames[i]);
205649ab747fSPaolo Bonzini             }
205749ab747fSPaolo Bonzini         }
205849ab747fSPaolo Bonzini         if (val & MFI_FWINIT_READY) {
205949ab747fSPaolo Bonzini             /* move to FW READY */
206049ab747fSPaolo Bonzini             megasas_soft_reset(s);
206149ab747fSPaolo Bonzini         }
206249ab747fSPaolo Bonzini         if (val & MFI_FWINIT_MFIMODE) {
206349ab747fSPaolo Bonzini             /* discard MFIs */
206449ab747fSPaolo Bonzini         }
2065e23d0498SHannes Reinecke         if (val & MFI_FWINIT_STOP_ADP) {
2066e23d0498SHannes Reinecke             /* Terminal error, stop processing */
2067e23d0498SHannes Reinecke             s->fw_state = MFI_FWSTATE_FAULT;
2068e23d0498SHannes Reinecke         }
206949ab747fSPaolo Bonzini         break;
207049ab747fSPaolo Bonzini     case MFI_OMSK:
207177bb6b17SHannes Reinecke         trace_megasas_mmio_writel("MFI_OMSK", val);
207249ab747fSPaolo Bonzini         s->intr_mask = val;
20734522b69cSHannes Reinecke         if (!megasas_intr_enabled(s) &&
20744522b69cSHannes Reinecke             !msi_enabled(pci_dev) &&
20754522b69cSHannes Reinecke             !msix_enabled(pci_dev)) {
207649ab747fSPaolo Bonzini             trace_megasas_irq_lower();
20779e64f8a3SMarcel Apfelbaum             pci_irq_deassert(pci_dev);
207849ab747fSPaolo Bonzini         }
207949ab747fSPaolo Bonzini         if (megasas_intr_enabled(s)) {
20804522b69cSHannes Reinecke             if (msix_enabled(pci_dev)) {
20814522b69cSHannes Reinecke                 trace_megasas_msix_enabled(0);
20824522b69cSHannes Reinecke             } else if (msi_enabled(pci_dev)) {
20834522b69cSHannes Reinecke                 trace_megasas_msi_enabled(0);
20844522b69cSHannes Reinecke             } else {
208549ab747fSPaolo Bonzini                 trace_megasas_intr_enabled();
20864522b69cSHannes Reinecke             }
208749ab747fSPaolo Bonzini         } else {
208849ab747fSPaolo Bonzini             trace_megasas_intr_disabled();
2089e23d0498SHannes Reinecke             megasas_soft_reset(s);
209049ab747fSPaolo Bonzini         }
209149ab747fSPaolo Bonzini         break;
209249ab747fSPaolo Bonzini     case MFI_ODCR0:
209377bb6b17SHannes Reinecke         trace_megasas_mmio_writel("MFI_ODCR0", val);
209449ab747fSPaolo Bonzini         s->doorbell = 0;
20957957ee71SHannes Reinecke         if (megasas_intr_enabled(s)) {
20967957ee71SHannes Reinecke             if (!msix_enabled(pci_dev) && !msi_enabled(pci_dev)) {
209749ab747fSPaolo Bonzini                 trace_megasas_irq_lower();
20989e64f8a3SMarcel Apfelbaum                 pci_irq_deassert(pci_dev);
209949ab747fSPaolo Bonzini             }
210049ab747fSPaolo Bonzini         }
210149ab747fSPaolo Bonzini         break;
210249ab747fSPaolo Bonzini     case MFI_IQPH:
210377bb6b17SHannes Reinecke         trace_megasas_mmio_writel("MFI_IQPH", val);
210449ab747fSPaolo Bonzini         /* Received high 32 bits of a 64 bit MFI frame address */
210549ab747fSPaolo Bonzini         s->frame_hi = val;
210649ab747fSPaolo Bonzini         break;
210749ab747fSPaolo Bonzini     case MFI_IQPL:
210877bb6b17SHannes Reinecke         trace_megasas_mmio_writel("MFI_IQPL", val);
210949ab747fSPaolo Bonzini         /* Received low 32 bits of a 64 bit MFI frame address */
2110e23d0498SHannes Reinecke         /* Fallthrough */
211149ab747fSPaolo Bonzini     case MFI_IQP:
211277bb6b17SHannes Reinecke         if (addr == MFI_IQP) {
211377bb6b17SHannes Reinecke             trace_megasas_mmio_writel("MFI_IQP", val);
2114e23d0498SHannes Reinecke             /* Received 64 bit MFI frame address */
211577bb6b17SHannes Reinecke             s->frame_hi = 0;
211677bb6b17SHannes Reinecke         }
211749ab747fSPaolo Bonzini         frame_addr = (val & ~0x1F);
211849ab747fSPaolo Bonzini         /* Add possible 64 bit offset */
211949ab747fSPaolo Bonzini         frame_addr |= ((uint64_t)s->frame_hi << 32);
212049ab747fSPaolo Bonzini         s->frame_hi = 0;
212149ab747fSPaolo Bonzini         frame_count = (val >> 1) & 0xF;
212249ab747fSPaolo Bonzini         megasas_handle_frame(s, frame_addr, frame_count);
212349ab747fSPaolo Bonzini         break;
2124e23d0498SHannes Reinecke     case MFI_SEQ:
212577bb6b17SHannes Reinecke         trace_megasas_mmio_writel("MFI_SEQ", val);
2126e23d0498SHannes Reinecke         /* Magic sequence to start ADP reset */
212724dfa9faSPrasad J Pandit         if (adp_reset_seq[s->adp_reset++] == val) {
212824dfa9faSPrasad J Pandit             if (s->adp_reset == 6) {
212924dfa9faSPrasad J Pandit                 s->adp_reset = 0;
213024dfa9faSPrasad J Pandit                 s->diag = MFI_DIAG_WRITE_ENABLE;
213124dfa9faSPrasad J Pandit             }
2132e23d0498SHannes Reinecke         } else {
2133e23d0498SHannes Reinecke             s->adp_reset = 0;
2134e23d0498SHannes Reinecke             s->diag = 0;
2135e23d0498SHannes Reinecke         }
2136e23d0498SHannes Reinecke         break;
2137e23d0498SHannes Reinecke     case MFI_DIAG:
213877bb6b17SHannes Reinecke         trace_megasas_mmio_writel("MFI_DIAG", val);
2139e23d0498SHannes Reinecke         /* ADP reset */
2140e23d0498SHannes Reinecke         if ((s->diag & MFI_DIAG_WRITE_ENABLE) &&
2141e23d0498SHannes Reinecke             (val & MFI_DIAG_RESET_ADP)) {
2142e23d0498SHannes Reinecke             s->diag |= MFI_DIAG_RESET_ADP;
2143e23d0498SHannes Reinecke             megasas_soft_reset(s);
2144e23d0498SHannes Reinecke             s->adp_reset = 0;
2145e23d0498SHannes Reinecke             s->diag = 0;
2146e23d0498SHannes Reinecke         }
2147e23d0498SHannes Reinecke         break;
214849ab747fSPaolo Bonzini     default:
214949ab747fSPaolo Bonzini         trace_megasas_mmio_invalid_writel(addr, val);
215049ab747fSPaolo Bonzini         break;
215149ab747fSPaolo Bonzini     }
215249ab747fSPaolo Bonzini }
215349ab747fSPaolo Bonzini 
215449ab747fSPaolo Bonzini static const MemoryRegionOps megasas_mmio_ops = {
215549ab747fSPaolo Bonzini     .read = megasas_mmio_read,
215649ab747fSPaolo Bonzini     .write = megasas_mmio_write,
215749ab747fSPaolo Bonzini     .endianness = DEVICE_LITTLE_ENDIAN,
215849ab747fSPaolo Bonzini     .impl = {
215949ab747fSPaolo Bonzini         .min_access_size = 8,
216049ab747fSPaolo Bonzini         .max_access_size = 8,
216149ab747fSPaolo Bonzini     }
216249ab747fSPaolo Bonzini };
216349ab747fSPaolo Bonzini 
216449ab747fSPaolo Bonzini static uint64_t megasas_port_read(void *opaque, hwaddr addr,
216549ab747fSPaolo Bonzini                                   unsigned size)
216649ab747fSPaolo Bonzini {
216749ab747fSPaolo Bonzini     return megasas_mmio_read(opaque, addr & 0xff, size);
216849ab747fSPaolo Bonzini }
216949ab747fSPaolo Bonzini 
217049ab747fSPaolo Bonzini static void megasas_port_write(void *opaque, hwaddr addr,
217149ab747fSPaolo Bonzini                                uint64_t val, unsigned size)
217249ab747fSPaolo Bonzini {
217349ab747fSPaolo Bonzini     megasas_mmio_write(opaque, addr & 0xff, val, size);
217449ab747fSPaolo Bonzini }
217549ab747fSPaolo Bonzini 
217649ab747fSPaolo Bonzini static const MemoryRegionOps megasas_port_ops = {
217749ab747fSPaolo Bonzini     .read = megasas_port_read,
217849ab747fSPaolo Bonzini     .write = megasas_port_write,
217949ab747fSPaolo Bonzini     .endianness = DEVICE_LITTLE_ENDIAN,
218049ab747fSPaolo Bonzini     .impl = {
218149ab747fSPaolo Bonzini         .min_access_size = 4,
218249ab747fSPaolo Bonzini         .max_access_size = 4,
218349ab747fSPaolo Bonzini     }
218449ab747fSPaolo Bonzini };
218549ab747fSPaolo Bonzini 
218649ab747fSPaolo Bonzini static uint64_t megasas_queue_read(void *opaque, hwaddr addr,
218749ab747fSPaolo Bonzini                                    unsigned size)
218849ab747fSPaolo Bonzini {
218949ab747fSPaolo Bonzini     return 0;
219049ab747fSPaolo Bonzini }
219149ab747fSPaolo Bonzini 
219255875fc4SSalva Peiró static void megasas_queue_write(void *opaque, hwaddr addr,
219355875fc4SSalva Peiró                                uint64_t val, unsigned size)
219455875fc4SSalva Peiró {
219555875fc4SSalva Peiró     return;
219655875fc4SSalva Peiró }
219755875fc4SSalva Peiró 
219849ab747fSPaolo Bonzini static const MemoryRegionOps megasas_queue_ops = {
219949ab747fSPaolo Bonzini     .read = megasas_queue_read,
220055875fc4SSalva Peiró     .write = megasas_queue_write,
220149ab747fSPaolo Bonzini     .endianness = DEVICE_LITTLE_ENDIAN,
220249ab747fSPaolo Bonzini     .impl = {
220349ab747fSPaolo Bonzini         .min_access_size = 8,
220449ab747fSPaolo Bonzini         .max_access_size = 8,
220549ab747fSPaolo Bonzini     }
220649ab747fSPaolo Bonzini };
220749ab747fSPaolo Bonzini 
220849ab747fSPaolo Bonzini static void megasas_soft_reset(MegasasState *s)
220949ab747fSPaolo Bonzini {
221049ab747fSPaolo Bonzini     int i;
221149ab747fSPaolo Bonzini     MegasasCmd *cmd;
221249ab747fSPaolo Bonzini 
22138d72db68SHannes Reinecke     trace_megasas_reset(s->fw_state);
221449ab747fSPaolo Bonzini     for (i = 0; i < s->fw_cmds; i++) {
221549ab747fSPaolo Bonzini         cmd = &s->frames[i];
221649ab747fSPaolo Bonzini         megasas_abort_command(cmd);
221749ab747fSPaolo Bonzini     }
22188d72db68SHannes Reinecke     if (s->fw_state == MFI_FWSTATE_READY) {
22198d72db68SHannes Reinecke         BusChild *kid;
22208d72db68SHannes Reinecke 
22218d72db68SHannes Reinecke         /*
22228d72db68SHannes Reinecke          * The EFI firmware doesn't handle UA,
22238d72db68SHannes Reinecke          * so we need to clear the Power On/Reset UA
22248d72db68SHannes Reinecke          * after the initial reset.
22258d72db68SHannes Reinecke          */
22268d72db68SHannes Reinecke         QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
2227e1dc6815SCao jin             SCSIDevice *sdev = SCSI_DEVICE(kid->child);
22288d72db68SHannes Reinecke 
22298d72db68SHannes Reinecke             sdev->unit_attention = SENSE_CODE(NO_SENSE);
22308d72db68SHannes Reinecke             scsi_device_unit_attention_reported(sdev);
22318d72db68SHannes Reinecke         }
22328d72db68SHannes Reinecke     }
223349ab747fSPaolo Bonzini     megasas_reset_frames(s);
223449ab747fSPaolo Bonzini     s->reply_queue_len = s->fw_cmds;
223549ab747fSPaolo Bonzini     s->reply_queue_pa = 0;
223649ab747fSPaolo Bonzini     s->consumer_pa = 0;
223749ab747fSPaolo Bonzini     s->producer_pa = 0;
223849ab747fSPaolo Bonzini     s->fw_state = MFI_FWSTATE_READY;
223949ab747fSPaolo Bonzini     s->doorbell = 0;
224049ab747fSPaolo Bonzini     s->intr_mask = MEGASAS_INTR_DISABLED_MASK;
224149ab747fSPaolo Bonzini     s->frame_hi = 0;
224249ab747fSPaolo Bonzini     s->flags &= ~MEGASAS_MASK_USE_QUEUE64;
224349ab747fSPaolo Bonzini     s->event_count++;
224449ab747fSPaolo Bonzini     s->boot_event = s->event_count;
224549ab747fSPaolo Bonzini }
224649ab747fSPaolo Bonzini 
224749ab747fSPaolo Bonzini static void megasas_scsi_reset(DeviceState *dev)
224849ab747fSPaolo Bonzini {
2249c79e16aeSPeter Crosthwaite     MegasasState *s = MEGASAS(dev);
225049ab747fSPaolo Bonzini 
225149ab747fSPaolo Bonzini     megasas_soft_reset(s);
225249ab747fSPaolo Bonzini }
225349ab747fSPaolo Bonzini 
2254e23d0498SHannes Reinecke static const VMStateDescription vmstate_megasas_gen1 = {
225549ab747fSPaolo Bonzini     .name = "megasas",
225649ab747fSPaolo Bonzini     .version_id = 0,
225749ab747fSPaolo Bonzini     .minimum_version_id = 0,
225849ab747fSPaolo Bonzini     .fields = (VMStateField[]) {
225952190c1eSAndreas Färber         VMSTATE_PCI_DEVICE(parent_obj, MegasasState),
226023335f62SHannes Reinecke         VMSTATE_MSIX(parent_obj, MegasasState),
226149ab747fSPaolo Bonzini 
2262*2b151297SPrasad J Pandit         VMSTATE_UINT32(fw_state, MegasasState),
2263*2b151297SPrasad J Pandit         VMSTATE_UINT32(intr_mask, MegasasState),
2264*2b151297SPrasad J Pandit         VMSTATE_UINT32(doorbell, MegasasState),
226549ab747fSPaolo Bonzini         VMSTATE_UINT64(reply_queue_pa, MegasasState),
226649ab747fSPaolo Bonzini         VMSTATE_UINT64(consumer_pa, MegasasState),
226749ab747fSPaolo Bonzini         VMSTATE_UINT64(producer_pa, MegasasState),
226849ab747fSPaolo Bonzini         VMSTATE_END_OF_LIST()
226949ab747fSPaolo Bonzini     }
227049ab747fSPaolo Bonzini };
227149ab747fSPaolo Bonzini 
2272e23d0498SHannes Reinecke static const VMStateDescription vmstate_megasas_gen2 = {
2273e23d0498SHannes Reinecke     .name = "megasas-gen2",
2274e23d0498SHannes Reinecke     .version_id = 0,
2275e23d0498SHannes Reinecke     .minimum_version_id = 0,
2276e23d0498SHannes Reinecke     .minimum_version_id_old = 0,
2277e23d0498SHannes Reinecke     .fields      = (VMStateField[]) {
227820daa90aSDr. David Alan Gilbert         VMSTATE_PCI_DEVICE(parent_obj, MegasasState),
2279e23d0498SHannes Reinecke         VMSTATE_MSIX(parent_obj, MegasasState),
2280e23d0498SHannes Reinecke 
2281*2b151297SPrasad J Pandit         VMSTATE_UINT32(fw_state, MegasasState),
2282*2b151297SPrasad J Pandit         VMSTATE_UINT32(intr_mask, MegasasState),
2283*2b151297SPrasad J Pandit         VMSTATE_UINT32(doorbell, MegasasState),
2284e23d0498SHannes Reinecke         VMSTATE_UINT64(reply_queue_pa, MegasasState),
2285e23d0498SHannes Reinecke         VMSTATE_UINT64(consumer_pa, MegasasState),
2286e23d0498SHannes Reinecke         VMSTATE_UINT64(producer_pa, MegasasState),
2287e23d0498SHannes Reinecke         VMSTATE_END_OF_LIST()
2288e23d0498SHannes Reinecke     }
2289e23d0498SHannes Reinecke };
2290e23d0498SHannes Reinecke 
229149ab747fSPaolo Bonzini static void megasas_scsi_uninit(PCIDevice *d)
229249ab747fSPaolo Bonzini {
2293c79e16aeSPeter Crosthwaite     MegasasState *s = MEGASAS(d);
229449ab747fSPaolo Bonzini 
22954522b69cSHannes Reinecke     if (megasas_use_msix(s)) {
229623335f62SHannes Reinecke         msix_uninit(d, &s->mmio_io, &s->mmio_io);
22974522b69cSHannes Reinecke     }
22984522b69cSHannes Reinecke     msi_uninit(d);
22994522b69cSHannes Reinecke }
230049ab747fSPaolo Bonzini 
230149ab747fSPaolo Bonzini static const struct SCSIBusInfo megasas_scsi_info = {
230249ab747fSPaolo Bonzini     .tcq = true,
230349ab747fSPaolo Bonzini     .max_target = MFI_MAX_LD,
230449ab747fSPaolo Bonzini     .max_lun = 255,
230549ab747fSPaolo Bonzini 
230649ab747fSPaolo Bonzini     .transfer_data = megasas_xfer_complete,
230749ab747fSPaolo Bonzini     .get_sg_list = megasas_get_sg_list,
230849ab747fSPaolo Bonzini     .complete = megasas_command_complete,
23099e55d588SPaolo Bonzini     .cancel = megasas_command_cancelled,
231049ab747fSPaolo Bonzini };
231149ab747fSPaolo Bonzini 
2312ae071cc8SMarkus Armbruster static void megasas_scsi_realize(PCIDevice *dev, Error **errp)
231349ab747fSPaolo Bonzini {
2314c79e16aeSPeter Crosthwaite     MegasasState *s = MEGASAS(dev);
2315e23d0498SHannes Reinecke     MegasasBaseClass *b = MEGASAS_DEVICE_GET_CLASS(s);
231649ab747fSPaolo Bonzini     uint8_t *pci_conf;
231749ab747fSPaolo Bonzini     int i, bar_type;
23181108b2f8SCao jin     Error *err = NULL;
23191108b2f8SCao jin     int ret;
232049ab747fSPaolo Bonzini 
232152190c1eSAndreas Färber     pci_conf = dev->config;
232249ab747fSPaolo Bonzini 
232349ab747fSPaolo Bonzini     /* PCI latency timer = 0 */
232449ab747fSPaolo Bonzini     pci_conf[PCI_LATENCY_TIMER] = 0;
232549ab747fSPaolo Bonzini     /* Interrupt pin 1 */
232649ab747fSPaolo Bonzini     pci_conf[PCI_INTERRUPT_PIN] = 0x01;
232749ab747fSPaolo Bonzini 
2328afea4e14SCao jin     if (s->msi != ON_OFF_AUTO_OFF) {
23291108b2f8SCao jin         ret = msi_init(dev, 0x50, 1, true, false, &err);
23301108b2f8SCao jin         /* Any error other than -ENOTSUP(board's MSI support is broken)
23311108b2f8SCao jin          * is a programming error */
23321108b2f8SCao jin         assert(!ret || ret == -ENOTSUP);
23331108b2f8SCao jin         if (ret && s->msi == ON_OFF_AUTO_ON) {
23341108b2f8SCao jin             /* Can't satisfy user's explicit msi=on request, fail */
23351108b2f8SCao jin             error_append_hint(&err, "You have to use msi=auto (default) or "
23361108b2f8SCao jin                     "msi=off with this machine type.\n");
23371108b2f8SCao jin             error_propagate(errp, err);
23381108b2f8SCao jin             return;
23391108b2f8SCao jin         } else if (ret) {
23401108b2f8SCao jin             /* With msi=auto, we fall back to MSI off silently */
23411108b2f8SCao jin             s->msi = ON_OFF_AUTO_OFF;
23421108b2f8SCao jin             error_free(err);
23431108b2f8SCao jin         }
23441108b2f8SCao jin     }
23451108b2f8SCao jin 
234629776739SPaolo Bonzini     memory_region_init_io(&s->mmio_io, OBJECT(s), &megasas_mmio_ops, s,
234749ab747fSPaolo Bonzini                           "megasas-mmio", 0x4000);
234829776739SPaolo Bonzini     memory_region_init_io(&s->port_io, OBJECT(s), &megasas_port_ops, s,
234949ab747fSPaolo Bonzini                           "megasas-io", 256);
235029776739SPaolo Bonzini     memory_region_init_io(&s->queue_io, OBJECT(s), &megasas_queue_ops, s,
235149ab747fSPaolo Bonzini                           "megasas-queue", 0x40000);
235249ab747fSPaolo Bonzini 
235349ab747fSPaolo Bonzini     if (megasas_use_msix(s) &&
2354e23d0498SHannes Reinecke         msix_init(dev, 15, &s->mmio_io, b->mmio_bar, 0x2000,
2355ee640c62SCao jin                   &s->mmio_io, b->mmio_bar, 0x3800, 0x68, NULL)) {
2356ee640c62SCao jin         /* TODO: check msix_init's error, and should fail on msix=on */
2357b4b4a57fSCao jin         s->msix = ON_OFF_AUTO_OFF;
235849ab747fSPaolo Bonzini     }
2359ee640c62SCao jin 
2360e23d0498SHannes Reinecke     if (pci_is_express(dev)) {
2361e23d0498SHannes Reinecke         pcie_endpoint_cap_init(dev, 0xa0);
2362e23d0498SHannes Reinecke     }
236349ab747fSPaolo Bonzini 
236449ab747fSPaolo Bonzini     bar_type = PCI_BASE_ADDRESS_SPACE_MEMORY | PCI_BASE_ADDRESS_MEM_TYPE_64;
2365e23d0498SHannes Reinecke     pci_register_bar(dev, b->ioport_bar,
2366e23d0498SHannes Reinecke                      PCI_BASE_ADDRESS_SPACE_IO, &s->port_io);
2367e23d0498SHannes Reinecke     pci_register_bar(dev, b->mmio_bar, bar_type, &s->mmio_io);
236852190c1eSAndreas Färber     pci_register_bar(dev, 3, bar_type, &s->queue_io);
236949ab747fSPaolo Bonzini 
237049ab747fSPaolo Bonzini     if (megasas_use_msix(s)) {
237152190c1eSAndreas Färber         msix_vector_use(dev, 0);
237249ab747fSPaolo Bonzini     }
237349ab747fSPaolo Bonzini 
23748d72db68SHannes Reinecke     s->fw_state = MFI_FWSTATE_READY;
237549ab747fSPaolo Bonzini     if (!s->sas_addr) {
237649ab747fSPaolo Bonzini         s->sas_addr = ((NAA_LOCALLY_ASSIGNED_ID << 24) |
237749ab747fSPaolo Bonzini                        IEEE_COMPANY_LOCALLY_ASSIGNED) << 36;
2378cdc57472SDavid Gibson         s->sas_addr |= (pci_dev_bus_num(dev) << 16);
237949ab747fSPaolo Bonzini         s->sas_addr |= (PCI_SLOT(dev->devfn) << 8);
238049ab747fSPaolo Bonzini         s->sas_addr |= PCI_FUNC(dev->devfn);
238149ab747fSPaolo Bonzini     }
238249ab747fSPaolo Bonzini     if (!s->hba_serial) {
238349ab747fSPaolo Bonzini         s->hba_serial = g_strdup(MEGASAS_HBA_SERIAL);
238449ab747fSPaolo Bonzini     }
238549ab747fSPaolo Bonzini     if (s->fw_sge >= MEGASAS_MAX_SGE - MFI_PASS_FRAME_SIZE) {
238649ab747fSPaolo Bonzini         s->fw_sge = MEGASAS_MAX_SGE - MFI_PASS_FRAME_SIZE;
238749ab747fSPaolo Bonzini     } else if (s->fw_sge >= 128 - MFI_PASS_FRAME_SIZE) {
238849ab747fSPaolo Bonzini         s->fw_sge = 128 - MFI_PASS_FRAME_SIZE;
238949ab747fSPaolo Bonzini     } else {
239049ab747fSPaolo Bonzini         s->fw_sge = 64 - MFI_PASS_FRAME_SIZE;
239149ab747fSPaolo Bonzini     }
239249ab747fSPaolo Bonzini     if (s->fw_cmds > MEGASAS_MAX_FRAMES) {
239349ab747fSPaolo Bonzini         s->fw_cmds = MEGASAS_MAX_FRAMES;
239449ab747fSPaolo Bonzini     }
239549ab747fSPaolo Bonzini     trace_megasas_init(s->fw_sge, s->fw_cmds,
239649ab747fSPaolo Bonzini                        megasas_is_jbod(s) ? "jbod" : "raid");
23973f2cd4ddSHannes Reinecke 
23983f2cd4ddSHannes Reinecke     if (megasas_is_jbod(s)) {
23993f2cd4ddSHannes Reinecke         s->fw_luns = MFI_MAX_SYS_PDS;
24003f2cd4ddSHannes Reinecke     } else {
24013f2cd4ddSHannes Reinecke         s->fw_luns = MFI_MAX_LD;
24023f2cd4ddSHannes Reinecke     }
240349ab747fSPaolo Bonzini     s->producer_pa = 0;
240449ab747fSPaolo Bonzini     s->consumer_pa = 0;
240549ab747fSPaolo Bonzini     for (i = 0; i < s->fw_cmds; i++) {
240649ab747fSPaolo Bonzini         s->frames[i].index = i;
240749ab747fSPaolo Bonzini         s->frames[i].context = -1;
240849ab747fSPaolo Bonzini         s->frames[i].pa = 0;
240949ab747fSPaolo Bonzini         s->frames[i].state = s;
241049ab747fSPaolo Bonzini     }
241149ab747fSPaolo Bonzini 
2412b1187b51SAndreas Färber     scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev),
2413b1187b51SAndreas Färber                  &megasas_scsi_info, NULL);
241422d6aa03SAndreas Färber }
241549ab747fSPaolo Bonzini 
2416e23d0498SHannes Reinecke static Property megasas_properties_gen1[] = {
241749ab747fSPaolo Bonzini     DEFINE_PROP_UINT32("max_sge", MegasasState, fw_sge,
241849ab747fSPaolo Bonzini                        MEGASAS_DEFAULT_SGE),
241949ab747fSPaolo Bonzini     DEFINE_PROP_UINT32("max_cmds", MegasasState, fw_cmds,
242049ab747fSPaolo Bonzini                        MEGASAS_DEFAULT_FRAMES),
242149ab747fSPaolo Bonzini     DEFINE_PROP_STRING("hba_serial", MegasasState, hba_serial),
2422c7bcc85dSPaolo Bonzini     DEFINE_PROP_UINT64("sas_address", MegasasState, sas_addr, 0),
2423b4b4a57fSCao jin     DEFINE_PROP_ON_OFF_AUTO("msi", MegasasState, msi, ON_OFF_AUTO_AUTO),
2424b4b4a57fSCao jin     DEFINE_PROP_ON_OFF_AUTO("msix", MegasasState, msix, ON_OFF_AUTO_AUTO),
242549ab747fSPaolo Bonzini     DEFINE_PROP_BIT("use_jbod", MegasasState, flags,
242649ab747fSPaolo Bonzini                     MEGASAS_FLAG_USE_JBOD, false),
242749ab747fSPaolo Bonzini     DEFINE_PROP_END_OF_LIST(),
242849ab747fSPaolo Bonzini };
242949ab747fSPaolo Bonzini 
2430e23d0498SHannes Reinecke static Property megasas_properties_gen2[] = {
2431e23d0498SHannes Reinecke     DEFINE_PROP_UINT32("max_sge", MegasasState, fw_sge,
2432e23d0498SHannes Reinecke                        MEGASAS_DEFAULT_SGE),
2433e23d0498SHannes Reinecke     DEFINE_PROP_UINT32("max_cmds", MegasasState, fw_cmds,
2434e23d0498SHannes Reinecke                        MEGASAS_GEN2_DEFAULT_FRAMES),
2435e23d0498SHannes Reinecke     DEFINE_PROP_STRING("hba_serial", MegasasState, hba_serial),
2436e23d0498SHannes Reinecke     DEFINE_PROP_UINT64("sas_address", MegasasState, sas_addr, 0),
2437b4b4a57fSCao jin     DEFINE_PROP_ON_OFF_AUTO("msi", MegasasState, msi, ON_OFF_AUTO_AUTO),
2438b4b4a57fSCao jin     DEFINE_PROP_ON_OFF_AUTO("msix", MegasasState, msix, ON_OFF_AUTO_AUTO),
2439e23d0498SHannes Reinecke     DEFINE_PROP_BIT("use_jbod", MegasasState, flags,
2440e23d0498SHannes Reinecke                     MEGASAS_FLAG_USE_JBOD, false),
2441e23d0498SHannes Reinecke     DEFINE_PROP_END_OF_LIST(),
2442e23d0498SHannes Reinecke };
2443e23d0498SHannes Reinecke 
2444e23d0498SHannes Reinecke typedef struct MegasasInfo {
2445e23d0498SHannes Reinecke     const char *name;
2446e23d0498SHannes Reinecke     const char *desc;
2447e23d0498SHannes Reinecke     const char *product_name;
2448e23d0498SHannes Reinecke     const char *product_version;
2449e23d0498SHannes Reinecke     uint16_t device_id;
2450e23d0498SHannes Reinecke     uint16_t subsystem_id;
2451e23d0498SHannes Reinecke     int ioport_bar;
2452e23d0498SHannes Reinecke     int mmio_bar;
2453e23d0498SHannes Reinecke     int osts;
2454e23d0498SHannes Reinecke     const VMStateDescription *vmsd;
2455e23d0498SHannes Reinecke     Property *props;
245671d78767SEduardo Habkost     InterfaceInfo *interfaces;
2457e23d0498SHannes Reinecke } MegasasInfo;
2458e23d0498SHannes Reinecke 
2459e23d0498SHannes Reinecke static struct MegasasInfo megasas_devices[] = {
2460e23d0498SHannes Reinecke     {
2461e23d0498SHannes Reinecke         .name = TYPE_MEGASAS_GEN1,
2462e23d0498SHannes Reinecke         .desc = "LSI MegaRAID SAS 1078",
2463e23d0498SHannes Reinecke         .product_name = "LSI MegaRAID SAS 8708EM2",
2464e23d0498SHannes Reinecke         .product_version = MEGASAS_VERSION_GEN1,
2465e23d0498SHannes Reinecke         .device_id = PCI_DEVICE_ID_LSI_SAS1078,
2466e23d0498SHannes Reinecke         .subsystem_id = 0x1013,
2467e23d0498SHannes Reinecke         .ioport_bar = 2,
2468e23d0498SHannes Reinecke         .mmio_bar = 0,
2469e23d0498SHannes Reinecke         .osts = MFI_1078_RM | 1,
2470e23d0498SHannes Reinecke         .vmsd = &vmstate_megasas_gen1,
2471e23d0498SHannes Reinecke         .props = megasas_properties_gen1,
2472fd3b02c8SEduardo Habkost         .interfaces = (InterfaceInfo[]) {
2473fd3b02c8SEduardo Habkost             { INTERFACE_CONVENTIONAL_PCI_DEVICE },
2474fd3b02c8SEduardo Habkost             { },
2475fd3b02c8SEduardo Habkost         },
2476e23d0498SHannes Reinecke     },{
2477e23d0498SHannes Reinecke         .name = TYPE_MEGASAS_GEN2,
2478e23d0498SHannes Reinecke         .desc = "LSI MegaRAID SAS 2108",
2479e23d0498SHannes Reinecke         .product_name = "LSI MegaRAID SAS 9260-8i",
2480e23d0498SHannes Reinecke         .product_version = MEGASAS_VERSION_GEN2,
2481e23d0498SHannes Reinecke         .device_id = PCI_DEVICE_ID_LSI_SAS0079,
2482e23d0498SHannes Reinecke         .subsystem_id = 0x9261,
2483e23d0498SHannes Reinecke         .ioport_bar = 0,
2484e23d0498SHannes Reinecke         .mmio_bar = 1,
2485e23d0498SHannes Reinecke         .osts = MFI_GEN2_RM,
2486e23d0498SHannes Reinecke         .vmsd = &vmstate_megasas_gen2,
2487e23d0498SHannes Reinecke         .props = megasas_properties_gen2,
248871d78767SEduardo Habkost         .interfaces = (InterfaceInfo[]) {
248971d78767SEduardo Habkost             { INTERFACE_PCIE_DEVICE },
249071d78767SEduardo Habkost             { }
249171d78767SEduardo Habkost         },
2492e23d0498SHannes Reinecke     }
2493e23d0498SHannes Reinecke };
2494e23d0498SHannes Reinecke 
249549ab747fSPaolo Bonzini static void megasas_class_init(ObjectClass *oc, void *data)
249649ab747fSPaolo Bonzini {
249749ab747fSPaolo Bonzini     DeviceClass *dc = DEVICE_CLASS(oc);
249849ab747fSPaolo Bonzini     PCIDeviceClass *pc = PCI_DEVICE_CLASS(oc);
2499e23d0498SHannes Reinecke     MegasasBaseClass *e = MEGASAS_DEVICE_CLASS(oc);
2500e23d0498SHannes Reinecke     const MegasasInfo *info = data;
250149ab747fSPaolo Bonzini 
2502ae071cc8SMarkus Armbruster     pc->realize = megasas_scsi_realize;
250349ab747fSPaolo Bonzini     pc->exit = megasas_scsi_uninit;
250449ab747fSPaolo Bonzini     pc->vendor_id = PCI_VENDOR_ID_LSI_LOGIC;
2505e23d0498SHannes Reinecke     pc->device_id = info->device_id;
250649ab747fSPaolo Bonzini     pc->subsystem_vendor_id = PCI_VENDOR_ID_LSI_LOGIC;
2507e23d0498SHannes Reinecke     pc->subsystem_id = info->subsystem_id;
250849ab747fSPaolo Bonzini     pc->class_id = PCI_CLASS_STORAGE_RAID;
2509e23d0498SHannes Reinecke     e->mmio_bar = info->mmio_bar;
2510e23d0498SHannes Reinecke     e->ioport_bar = info->ioport_bar;
2511e23d0498SHannes Reinecke     e->osts = info->osts;
2512e23d0498SHannes Reinecke     e->product_name = info->product_name;
2513e23d0498SHannes Reinecke     e->product_version = info->product_version;
25144f67d30bSMarc-André Lureau     device_class_set_props(dc, info->props);
251549ab747fSPaolo Bonzini     dc->reset = megasas_scsi_reset;
2516e23d0498SHannes Reinecke     dc->vmsd = info->vmsd;
2517125ee0edSMarcel Apfelbaum     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
2518e23d0498SHannes Reinecke     dc->desc = info->desc;
251949ab747fSPaolo Bonzini }
252049ab747fSPaolo Bonzini 
252149ab747fSPaolo Bonzini static const TypeInfo megasas_info = {
2522e23d0498SHannes Reinecke     .name  = TYPE_MEGASAS_BASE,
252349ab747fSPaolo Bonzini     .parent = TYPE_PCI_DEVICE,
252449ab747fSPaolo Bonzini     .instance_size = sizeof(MegasasState),
2525e23d0498SHannes Reinecke     .class_size = sizeof(MegasasBaseClass),
2526e23d0498SHannes Reinecke     .abstract = true,
252749ab747fSPaolo Bonzini };
252849ab747fSPaolo Bonzini 
252949ab747fSPaolo Bonzini static void megasas_register_types(void)
253049ab747fSPaolo Bonzini {
2531e23d0498SHannes Reinecke     int i;
2532e23d0498SHannes Reinecke 
253349ab747fSPaolo Bonzini     type_register_static(&megasas_info);
2534e23d0498SHannes Reinecke     for (i = 0; i < ARRAY_SIZE(megasas_devices); i++) {
2535e23d0498SHannes Reinecke         const MegasasInfo *info = &megasas_devices[i];
2536e23d0498SHannes Reinecke         TypeInfo type_info = {};
2537e23d0498SHannes Reinecke 
2538e23d0498SHannes Reinecke         type_info.name = info->name;
2539e23d0498SHannes Reinecke         type_info.parent = TYPE_MEGASAS_BASE;
2540e23d0498SHannes Reinecke         type_info.class_data = (void *)info;
2541e23d0498SHannes Reinecke         type_info.class_init = megasas_class_init;
254271d78767SEduardo Habkost         type_info.interfaces = info->interfaces;
2543e23d0498SHannes Reinecke 
2544e23d0498SHannes Reinecke         type_register(&type_info);
2545e23d0498SHannes Reinecke     }
254649ab747fSPaolo Bonzini }
254749ab747fSPaolo Bonzini 
254849ab747fSPaolo Bonzini type_init(megasas_register_types)
2549