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