xref: /openbmc/qemu/hw/scsi/megasas.c (revision bfa30f3903e0542611196b21f5832a4be5775a21)
1 /*
2  * QEMU MegaRAID SAS 8708EM2 Host Bus Adapter emulation
3  * Based on the linux driver code at drivers/scsi/megaraid
4  *
5  * Copyright (c) 2009-2012 Hannes Reinecke, SUSE Labs
6  *
7  * This library is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU Lesser General Public
9  * License as published by the Free Software Foundation; either
10  * version 2.1 of the License, or (at your option) any later version.
11  *
12  * This library is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15  * Lesser General Public License for more details.
16  *
17  * You should have received a copy of the GNU Lesser General Public
18  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
19  */
20 
21 #include "qemu/osdep.h"
22 #include "qemu-common.h"
23 #include "hw/pci/pci.h"
24 #include "hw/qdev-properties.h"
25 #include "sysemu/dma.h"
26 #include "sysemu/block-backend.h"
27 #include "hw/pci/msi.h"
28 #include "hw/pci/msix.h"
29 #include "qemu/iov.h"
30 #include "qemu/module.h"
31 #include "hw/scsi/scsi.h"
32 #include "scsi/constants.h"
33 #include "trace.h"
34 #include "qapi/error.h"
35 #include "mfi.h"
36 #include "migration/vmstate.h"
37 #include "qom/object.h"
38 
39 #define MEGASAS_VERSION_GEN1 "1.70"
40 #define MEGASAS_VERSION_GEN2 "1.80"
41 #define MEGASAS_MAX_FRAMES 2048         /* Firmware limit at 65535 */
42 #define MEGASAS_DEFAULT_FRAMES 1000     /* Windows requires this */
43 #define MEGASAS_GEN2_DEFAULT_FRAMES 1008     /* Windows requires this */
44 #define MEGASAS_MAX_SGE 128             /* Firmware limit */
45 #define MEGASAS_DEFAULT_SGE 80
46 #define MEGASAS_MAX_SECTORS 0xFFFF      /* No real limit */
47 #define MEGASAS_MAX_ARRAYS 128
48 
49 #define MEGASAS_HBA_SERIAL "QEMU123456"
50 #define NAA_LOCALLY_ASSIGNED_ID 0x3ULL
51 #define IEEE_COMPANY_LOCALLY_ASSIGNED 0x525400
52 
53 #define MEGASAS_FLAG_USE_JBOD      0
54 #define MEGASAS_MASK_USE_JBOD      (1 << MEGASAS_FLAG_USE_JBOD)
55 #define MEGASAS_FLAG_USE_QUEUE64   1
56 #define MEGASAS_MASK_USE_QUEUE64   (1 << MEGASAS_FLAG_USE_QUEUE64)
57 
58 typedef struct MegasasCmd {
59     uint32_t index;
60     uint16_t flags;
61     uint16_t count;
62     uint64_t context;
63 
64     hwaddr pa;
65     hwaddr pa_size;
66     uint32_t dcmd_opcode;
67     union mfi_frame *frame;
68     SCSIRequest *req;
69     QEMUSGList qsg;
70     void *iov_buf;
71     size_t iov_size;
72     size_t iov_offset;
73     struct MegasasState *state;
74 } MegasasCmd;
75 
76 struct MegasasState {
77     /*< private >*/
78     PCIDevice parent_obj;
79     /*< public >*/
80 
81     MemoryRegion mmio_io;
82     MemoryRegion port_io;
83     MemoryRegion queue_io;
84     uint32_t frame_hi;
85 
86     uint32_t fw_state;
87     uint32_t fw_sge;
88     uint32_t fw_cmds;
89     uint32_t flags;
90     uint32_t fw_luns;
91     uint32_t intr_mask;
92     uint32_t doorbell;
93     uint32_t busy;
94     uint32_t diag;
95     uint32_t adp_reset;
96     OnOffAuto msi;
97     OnOffAuto msix;
98 
99     MegasasCmd *event_cmd;
100     uint16_t event_locale;
101     int event_class;
102     uint32_t event_count;
103     uint32_t shutdown_event;
104     uint32_t boot_event;
105 
106     uint64_t sas_addr;
107     char *hba_serial;
108 
109     uint64_t reply_queue_pa;
110     void *reply_queue;
111     uint16_t reply_queue_len;
112     uint32_t reply_queue_head;
113     uint32_t reply_queue_tail;
114     uint64_t consumer_pa;
115     uint64_t producer_pa;
116 
117     MegasasCmd frames[MEGASAS_MAX_FRAMES];
118     DECLARE_BITMAP(frame_map, MEGASAS_MAX_FRAMES);
119     SCSIBus bus;
120 };
121 typedef struct MegasasState MegasasState;
122 
123 struct MegasasBaseClass {
124     PCIDeviceClass parent_class;
125     const char *product_name;
126     const char *product_version;
127     int mmio_bar;
128     int ioport_bar;
129     int osts;
130 };
131 typedef struct MegasasBaseClass MegasasBaseClass;
132 
133 #define TYPE_MEGASAS_BASE "megasas-base"
134 #define TYPE_MEGASAS_GEN1 "megasas"
135 #define TYPE_MEGASAS_GEN2 "megasas-gen2"
136 
137 DECLARE_OBJ_CHECKERS(MegasasState, MegasasBaseClass,
138                      MEGASAS, TYPE_MEGASAS_BASE)
139 
140 
141 #define MEGASAS_INTR_DISABLED_MASK 0xFFFFFFFF
142 
143 static bool megasas_intr_enabled(MegasasState *s)
144 {
145     if ((s->intr_mask & MEGASAS_INTR_DISABLED_MASK) !=
146         MEGASAS_INTR_DISABLED_MASK) {
147         return true;
148     }
149     return false;
150 }
151 
152 static bool megasas_use_queue64(MegasasState *s)
153 {
154     return s->flags & MEGASAS_MASK_USE_QUEUE64;
155 }
156 
157 static bool megasas_use_msix(MegasasState *s)
158 {
159     return s->msix != ON_OFF_AUTO_OFF;
160 }
161 
162 static bool megasas_is_jbod(MegasasState *s)
163 {
164     return s->flags & MEGASAS_MASK_USE_JBOD;
165 }
166 
167 static void megasas_frame_set_cmd_status(MegasasState *s,
168                                          unsigned long frame, uint8_t v)
169 {
170     PCIDevice *pci = &s->parent_obj;
171     stb_pci_dma(pci, frame + offsetof(struct mfi_frame_header, cmd_status),
172                 v, MEMTXATTRS_UNSPECIFIED);
173 }
174 
175 static void megasas_frame_set_scsi_status(MegasasState *s,
176                                           unsigned long frame, uint8_t v)
177 {
178     PCIDevice *pci = &s->parent_obj;
179     stb_pci_dma(pci, frame + offsetof(struct mfi_frame_header, scsi_status),
180                 v, MEMTXATTRS_UNSPECIFIED);
181 }
182 
183 static inline const char *mfi_frame_desc(unsigned int cmd)
184 {
185     static const char *mfi_frame_descs[] = {
186         "MFI init", "LD Read", "LD Write", "LD SCSI", "PD SCSI",
187         "MFI Doorbell", "MFI Abort", "MFI SMP", "MFI Stop"
188     };
189 
190     if (cmd < ARRAY_SIZE(mfi_frame_descs)) {
191         return mfi_frame_descs[cmd];
192     }
193 
194     return "Unknown";
195 }
196 
197 /*
198  * Context is considered opaque, but the HBA firmware is running
199  * in little endian mode. So convert it to little endian, too.
200  */
201 static uint64_t megasas_frame_get_context(MegasasState *s,
202                                           unsigned long frame)
203 {
204     PCIDevice *pci = &s->parent_obj;
205     uint64_t val;
206 
207     ldq_le_pci_dma(pci, frame + offsetof(struct mfi_frame_header, context),
208                    &val, MEMTXATTRS_UNSPECIFIED);
209 
210     return val;
211 }
212 
213 static bool megasas_frame_is_ieee_sgl(MegasasCmd *cmd)
214 {
215     return cmd->flags & MFI_FRAME_IEEE_SGL;
216 }
217 
218 static bool megasas_frame_is_sgl64(MegasasCmd *cmd)
219 {
220     return cmd->flags & MFI_FRAME_SGL64;
221 }
222 
223 static bool megasas_frame_is_sense64(MegasasCmd *cmd)
224 {
225     return cmd->flags & MFI_FRAME_SENSE64;
226 }
227 
228 static uint64_t megasas_sgl_get_addr(MegasasCmd *cmd,
229                                      union mfi_sgl *sgl)
230 {
231     uint64_t addr;
232 
233     if (megasas_frame_is_ieee_sgl(cmd)) {
234         addr = le64_to_cpu(sgl->sg_skinny->addr);
235     } else if (megasas_frame_is_sgl64(cmd)) {
236         addr = le64_to_cpu(sgl->sg64->addr);
237     } else {
238         addr = le32_to_cpu(sgl->sg32->addr);
239     }
240     return addr;
241 }
242 
243 static uint32_t megasas_sgl_get_len(MegasasCmd *cmd,
244                                     union mfi_sgl *sgl)
245 {
246     uint32_t len;
247 
248     if (megasas_frame_is_ieee_sgl(cmd)) {
249         len = le32_to_cpu(sgl->sg_skinny->len);
250     } else if (megasas_frame_is_sgl64(cmd)) {
251         len = le32_to_cpu(sgl->sg64->len);
252     } else {
253         len = le32_to_cpu(sgl->sg32->len);
254     }
255     return len;
256 }
257 
258 static union mfi_sgl *megasas_sgl_next(MegasasCmd *cmd,
259                                        union mfi_sgl *sgl)
260 {
261     uint8_t *next = (uint8_t *)sgl;
262 
263     if (megasas_frame_is_ieee_sgl(cmd)) {
264         next += sizeof(struct mfi_sg_skinny);
265     } else if (megasas_frame_is_sgl64(cmd)) {
266         next += sizeof(struct mfi_sg64);
267     } else {
268         next += sizeof(struct mfi_sg32);
269     }
270 
271     if (next >= (uint8_t *)cmd->frame + cmd->pa_size) {
272         return NULL;
273     }
274     return (union mfi_sgl *)next;
275 }
276 
277 static void megasas_soft_reset(MegasasState *s);
278 
279 static int megasas_map_sgl(MegasasState *s, MegasasCmd *cmd, union mfi_sgl *sgl)
280 {
281     int i;
282     int iov_count = 0;
283     size_t iov_size = 0;
284 
285     cmd->flags = le16_to_cpu(cmd->frame->header.flags);
286     iov_count = cmd->frame->header.sge_count;
287     if (!iov_count || iov_count > MEGASAS_MAX_SGE) {
288         trace_megasas_iovec_sgl_overflow(cmd->index, iov_count,
289                                          MEGASAS_MAX_SGE);
290         return -1;
291     }
292     pci_dma_sglist_init(&cmd->qsg, PCI_DEVICE(s), iov_count);
293     for (i = 0; i < iov_count; i++) {
294         dma_addr_t iov_pa, iov_size_p;
295 
296         if (!sgl) {
297             trace_megasas_iovec_sgl_underflow(cmd->index, i);
298             goto unmap;
299         }
300         iov_pa = megasas_sgl_get_addr(cmd, sgl);
301         iov_size_p = megasas_sgl_get_len(cmd, sgl);
302         if (!iov_pa || !iov_size_p) {
303             trace_megasas_iovec_sgl_invalid(cmd->index, i,
304                                             iov_pa, iov_size_p);
305             goto unmap;
306         }
307         qemu_sglist_add(&cmd->qsg, iov_pa, iov_size_p);
308         sgl = megasas_sgl_next(cmd, sgl);
309         iov_size += (size_t)iov_size_p;
310     }
311     if (cmd->iov_size > iov_size) {
312         trace_megasas_iovec_overflow(cmd->index, iov_size, cmd->iov_size);
313         goto unmap;
314     } else if (cmd->iov_size < iov_size) {
315         trace_megasas_iovec_underflow(cmd->index, iov_size, cmd->iov_size);
316     }
317     cmd->iov_offset = 0;
318     return 0;
319 unmap:
320     qemu_sglist_destroy(&cmd->qsg);
321     return -1;
322 }
323 
324 /*
325  * passthrough sense and io sense are at the same offset
326  */
327 static int megasas_build_sense(MegasasCmd *cmd, uint8_t *sense_ptr,
328     uint8_t sense_len)
329 {
330     PCIDevice *pcid = PCI_DEVICE(cmd->state);
331     uint32_t pa_hi = 0, pa_lo;
332     hwaddr pa;
333     int frame_sense_len;
334 
335     frame_sense_len = cmd->frame->header.sense_len;
336     if (sense_len > frame_sense_len) {
337         sense_len = frame_sense_len;
338     }
339     if (sense_len) {
340         pa_lo = le32_to_cpu(cmd->frame->pass.sense_addr_lo);
341         if (megasas_frame_is_sense64(cmd)) {
342             pa_hi = le32_to_cpu(cmd->frame->pass.sense_addr_hi);
343         }
344         pa = ((uint64_t) pa_hi << 32) | pa_lo;
345         pci_dma_write(pcid, pa, sense_ptr, sense_len);
346         cmd->frame->header.sense_len = sense_len;
347     }
348     return sense_len;
349 }
350 
351 static void megasas_write_sense(MegasasCmd *cmd, SCSISense sense)
352 {
353     uint8_t sense_buf[SCSI_SENSE_BUF_SIZE];
354     uint8_t sense_len = 18;
355 
356     memset(sense_buf, 0, sense_len);
357     sense_buf[0] = 0xf0;
358     sense_buf[2] = sense.key;
359     sense_buf[7] = 10;
360     sense_buf[12] = sense.asc;
361     sense_buf[13] = sense.ascq;
362     megasas_build_sense(cmd, sense_buf, sense_len);
363 }
364 
365 static void megasas_copy_sense(MegasasCmd *cmd)
366 {
367     uint8_t sense_buf[SCSI_SENSE_BUF_SIZE];
368     uint8_t sense_len;
369 
370     sense_len = scsi_req_get_sense(cmd->req, sense_buf,
371                                    SCSI_SENSE_BUF_SIZE);
372     megasas_build_sense(cmd, sense_buf, sense_len);
373 }
374 
375 /*
376  * Format an INQUIRY CDB
377  */
378 static int megasas_setup_inquiry(uint8_t *cdb, int pg, int len)
379 {
380     memset(cdb, 0, 6);
381     cdb[0] = INQUIRY;
382     if (pg > 0) {
383         cdb[1] = 0x1;
384         cdb[2] = pg;
385     }
386     cdb[3] = (len >> 8) & 0xff;
387     cdb[4] = (len & 0xff);
388     return len;
389 }
390 
391 /*
392  * Encode lba and len into a READ_16/WRITE_16 CDB
393  */
394 static void megasas_encode_lba(uint8_t *cdb, uint64_t lba,
395                                uint32_t len, bool is_write)
396 {
397     memset(cdb, 0x0, 16);
398     if (is_write) {
399         cdb[0] = WRITE_16;
400     } else {
401         cdb[0] = READ_16;
402     }
403     cdb[2] = (lba >> 56) & 0xff;
404     cdb[3] = (lba >> 48) & 0xff;
405     cdb[4] = (lba >> 40) & 0xff;
406     cdb[5] = (lba >> 32) & 0xff;
407     cdb[6] = (lba >> 24) & 0xff;
408     cdb[7] = (lba >> 16) & 0xff;
409     cdb[8] = (lba >> 8) & 0xff;
410     cdb[9] = (lba) & 0xff;
411     cdb[10] = (len >> 24) & 0xff;
412     cdb[11] = (len >> 16) & 0xff;
413     cdb[12] = (len >> 8) & 0xff;
414     cdb[13] = (len) & 0xff;
415 }
416 
417 /*
418  * Utility functions
419  */
420 static uint64_t megasas_fw_time(void)
421 {
422     struct tm curtime;
423 
424     qemu_get_timedate(&curtime, 0);
425     return ((uint64_t)curtime.tm_sec & 0xff) << 48 |
426         ((uint64_t)curtime.tm_min & 0xff)  << 40 |
427         ((uint64_t)curtime.tm_hour & 0xff) << 32 |
428         ((uint64_t)curtime.tm_mday & 0xff) << 24 |
429         ((uint64_t)curtime.tm_mon & 0xff)  << 16 |
430         ((uint64_t)(curtime.tm_year + 1900) & 0xffff);
431 }
432 
433 /*
434  * Default disk sata address
435  * 0x1221 is the magic number as
436  * present in real hardware,
437  * so use it here, too.
438  */
439 static uint64_t megasas_get_sata_addr(uint16_t id)
440 {
441     uint64_t addr = (0x1221ULL << 48);
442     return addr | ((uint64_t)id << 24);
443 }
444 
445 /*
446  * Frame handling
447  */
448 static int megasas_next_index(MegasasState *s, int index, int limit)
449 {
450     index++;
451     if (index == limit) {
452         index = 0;
453     }
454     return index;
455 }
456 
457 static MegasasCmd *megasas_lookup_frame(MegasasState *s,
458     hwaddr frame)
459 {
460     MegasasCmd *cmd = NULL;
461     int num = 0, index;
462 
463     index = s->reply_queue_head;
464 
465     while (num < s->fw_cmds && index < MEGASAS_MAX_FRAMES) {
466         if (s->frames[index].pa && s->frames[index].pa == frame) {
467             cmd = &s->frames[index];
468             break;
469         }
470         index = megasas_next_index(s, index, s->fw_cmds);
471         num++;
472     }
473 
474     return cmd;
475 }
476 
477 static void megasas_unmap_frame(MegasasState *s, MegasasCmd *cmd)
478 {
479     PCIDevice *p = PCI_DEVICE(s);
480 
481     if (cmd->pa_size) {
482         pci_dma_unmap(p, cmd->frame, cmd->pa_size, 0, 0);
483     }
484     cmd->frame = NULL;
485     cmd->pa = 0;
486     cmd->pa_size = 0;
487     qemu_sglist_destroy(&cmd->qsg);
488     clear_bit(cmd->index, s->frame_map);
489 }
490 
491 /*
492  * This absolutely needs to be locked if
493  * qemu ever goes multithreaded.
494  */
495 static MegasasCmd *megasas_enqueue_frame(MegasasState *s,
496     hwaddr frame, uint64_t context, int count)
497 {
498     PCIDevice *pcid = PCI_DEVICE(s);
499     MegasasCmd *cmd = NULL;
500     int frame_size = MEGASAS_MAX_SGE * sizeof(union mfi_sgl);
501     hwaddr frame_size_p = frame_size;
502     unsigned long index;
503 
504     index = 0;
505     while (index < s->fw_cmds) {
506         index = find_next_zero_bit(s->frame_map, s->fw_cmds, index);
507         if (!s->frames[index].pa)
508             break;
509         /* Busy frame found */
510         trace_megasas_qf_mapped(index);
511     }
512     if (index >= s->fw_cmds) {
513         /* All frames busy */
514         trace_megasas_qf_busy(frame);
515         return NULL;
516     }
517     cmd = &s->frames[index];
518     set_bit(index, s->frame_map);
519     trace_megasas_qf_new(index, frame);
520 
521     cmd->pa = frame;
522     /* Map all possible frames */
523     cmd->frame = pci_dma_map(pcid, frame, &frame_size_p, 0);
524     if (!cmd->frame || frame_size_p != frame_size) {
525         trace_megasas_qf_map_failed(cmd->index, (unsigned long)frame);
526         if (cmd->frame) {
527             megasas_unmap_frame(s, cmd);
528         }
529         s->event_count++;
530         return NULL;
531     }
532     cmd->pa_size = frame_size_p;
533     cmd->context = context;
534     if (!megasas_use_queue64(s)) {
535         cmd->context &= (uint64_t)0xFFFFFFFF;
536     }
537     cmd->count = count;
538     cmd->dcmd_opcode = -1;
539     s->busy++;
540 
541     if (s->consumer_pa) {
542         ldl_le_pci_dma(pcid, s->consumer_pa, &s->reply_queue_tail,
543                        MEMTXATTRS_UNSPECIFIED);
544     }
545     trace_megasas_qf_enqueue(cmd->index, cmd->count, cmd->context,
546                              s->reply_queue_head, s->reply_queue_tail, s->busy);
547 
548     return cmd;
549 }
550 
551 static void megasas_complete_frame(MegasasState *s, uint64_t context)
552 {
553     const MemTxAttrs attrs = MEMTXATTRS_UNSPECIFIED;
554     PCIDevice *pci_dev = PCI_DEVICE(s);
555     int tail, queue_offset;
556 
557     /* Decrement busy count */
558     s->busy--;
559     if (s->reply_queue_pa) {
560         /*
561          * Put command on the reply queue.
562          * Context is opaque, but emulation is running in
563          * little endian. So convert it.
564          */
565         if (megasas_use_queue64(s)) {
566             queue_offset = s->reply_queue_head * sizeof(uint64_t);
567             stq_le_pci_dma(pci_dev, s->reply_queue_pa + queue_offset,
568                            context, attrs);
569         } else {
570             queue_offset = s->reply_queue_head * sizeof(uint32_t);
571             stl_le_pci_dma(pci_dev, s->reply_queue_pa + queue_offset,
572                            context, attrs);
573         }
574         ldl_le_pci_dma(pci_dev, s->consumer_pa, &s->reply_queue_tail, attrs);
575         trace_megasas_qf_complete(context, s->reply_queue_head,
576                                   s->reply_queue_tail, s->busy);
577     }
578 
579     if (megasas_intr_enabled(s)) {
580         /* Update reply queue pointer */
581         ldl_le_pci_dma(pci_dev, s->consumer_pa, &s->reply_queue_tail, attrs);
582         tail = s->reply_queue_head;
583         s->reply_queue_head = megasas_next_index(s, tail, s->fw_cmds);
584         trace_megasas_qf_update(s->reply_queue_head, s->reply_queue_tail,
585                                 s->busy);
586         stl_le_pci_dma(pci_dev, s->producer_pa, s->reply_queue_head, attrs);
587         /* Notify HBA */
588         if (msix_enabled(pci_dev)) {
589             trace_megasas_msix_raise(0);
590             msix_notify(pci_dev, 0);
591         } else if (msi_enabled(pci_dev)) {
592             trace_megasas_msi_raise(0);
593             msi_notify(pci_dev, 0);
594         } else {
595             s->doorbell++;
596             if (s->doorbell == 1) {
597                 trace_megasas_irq_raise();
598                 pci_irq_assert(pci_dev);
599             }
600         }
601     } else {
602         trace_megasas_qf_complete_noirq(context);
603     }
604 }
605 
606 static void megasas_complete_command(MegasasCmd *cmd)
607 {
608     cmd->iov_size = 0;
609     cmd->iov_offset = 0;
610 
611     cmd->req->hba_private = NULL;
612     scsi_req_unref(cmd->req);
613     cmd->req = NULL;
614 
615     megasas_unmap_frame(cmd->state, cmd);
616     megasas_complete_frame(cmd->state, cmd->context);
617 }
618 
619 static void megasas_reset_frames(MegasasState *s)
620 {
621     int i;
622     MegasasCmd *cmd;
623 
624     for (i = 0; i < s->fw_cmds; i++) {
625         cmd = &s->frames[i];
626         if (cmd->pa) {
627             megasas_unmap_frame(s, cmd);
628         }
629     }
630     bitmap_zero(s->frame_map, MEGASAS_MAX_FRAMES);
631 }
632 
633 static void megasas_abort_command(MegasasCmd *cmd)
634 {
635     /* Never abort internal commands.  */
636     if (cmd->dcmd_opcode != -1) {
637         return;
638     }
639     if (cmd->req != NULL) {
640         scsi_req_cancel(cmd->req);
641     }
642 }
643 
644 static int megasas_init_firmware(MegasasState *s, MegasasCmd *cmd)
645 {
646     const MemTxAttrs attrs = MEMTXATTRS_UNSPECIFIED;
647     PCIDevice *pcid = PCI_DEVICE(s);
648     uint32_t pa_hi, pa_lo;
649     hwaddr iq_pa, initq_size = sizeof(struct mfi_init_qinfo);
650     struct mfi_init_qinfo *initq = NULL;
651     uint32_t flags;
652     int ret = MFI_STAT_OK;
653 
654     if (s->reply_queue_pa) {
655         trace_megasas_initq_mapped(s->reply_queue_pa);
656         goto out;
657     }
658     pa_lo = le32_to_cpu(cmd->frame->init.qinfo_new_addr_lo);
659     pa_hi = le32_to_cpu(cmd->frame->init.qinfo_new_addr_hi);
660     iq_pa = (((uint64_t) pa_hi << 32) | pa_lo);
661     trace_megasas_init_firmware((uint64_t)iq_pa);
662     initq = pci_dma_map(pcid, iq_pa, &initq_size, 0);
663     if (!initq || initq_size != sizeof(*initq)) {
664         trace_megasas_initq_map_failed(cmd->index);
665         s->event_count++;
666         ret = MFI_STAT_MEMORY_NOT_AVAILABLE;
667         goto out;
668     }
669     s->reply_queue_len = le32_to_cpu(initq->rq_entries) & 0xFFFF;
670     if (s->reply_queue_len > s->fw_cmds) {
671         trace_megasas_initq_mismatch(s->reply_queue_len, s->fw_cmds);
672         s->event_count++;
673         ret = MFI_STAT_INVALID_PARAMETER;
674         goto out;
675     }
676     pa_lo = le32_to_cpu(initq->rq_addr_lo);
677     pa_hi = le32_to_cpu(initq->rq_addr_hi);
678     s->reply_queue_pa = ((uint64_t) pa_hi << 32) | pa_lo;
679     pa_lo = le32_to_cpu(initq->ci_addr_lo);
680     pa_hi = le32_to_cpu(initq->ci_addr_hi);
681     s->consumer_pa = ((uint64_t) pa_hi << 32) | pa_lo;
682     pa_lo = le32_to_cpu(initq->pi_addr_lo);
683     pa_hi = le32_to_cpu(initq->pi_addr_hi);
684     s->producer_pa = ((uint64_t) pa_hi << 32) | pa_lo;
685     ldl_le_pci_dma(pcid, s->producer_pa, &s->reply_queue_head, attrs);
686     s->reply_queue_head %= MEGASAS_MAX_FRAMES;
687     ldl_le_pci_dma(pcid, s->consumer_pa, &s->reply_queue_tail, attrs);
688     s->reply_queue_tail %= MEGASAS_MAX_FRAMES;
689     flags = le32_to_cpu(initq->flags);
690     if (flags & MFI_QUEUE_FLAG_CONTEXT64) {
691         s->flags |= MEGASAS_MASK_USE_QUEUE64;
692     }
693     trace_megasas_init_queue((unsigned long)s->reply_queue_pa,
694                              s->reply_queue_len, s->reply_queue_head,
695                              s->reply_queue_tail, flags);
696     megasas_reset_frames(s);
697     s->fw_state = MFI_FWSTATE_OPERATIONAL;
698 out:
699     if (initq) {
700         pci_dma_unmap(pcid, initq, initq_size, 0, 0);
701     }
702     return ret;
703 }
704 
705 static int megasas_map_dcmd(MegasasState *s, MegasasCmd *cmd)
706 {
707     dma_addr_t iov_pa, iov_size;
708     int iov_count;
709 
710     cmd->flags = le16_to_cpu(cmd->frame->header.flags);
711     iov_count = cmd->frame->header.sge_count;
712     if (!iov_count) {
713         trace_megasas_dcmd_zero_sge(cmd->index);
714         cmd->iov_size = 0;
715         return 0;
716     } else if (iov_count > 1) {
717         trace_megasas_dcmd_invalid_sge(cmd->index, iov_count);
718         cmd->iov_size = 0;
719         return -EINVAL;
720     }
721     iov_pa = megasas_sgl_get_addr(cmd, &cmd->frame->dcmd.sgl);
722     iov_size = megasas_sgl_get_len(cmd, &cmd->frame->dcmd.sgl);
723     pci_dma_sglist_init(&cmd->qsg, PCI_DEVICE(s), 1);
724     qemu_sglist_add(&cmd->qsg, iov_pa, iov_size);
725     cmd->iov_size = iov_size;
726     return 0;
727 }
728 
729 static void megasas_finish_dcmd(MegasasCmd *cmd, uint32_t iov_size)
730 {
731     trace_megasas_finish_dcmd(cmd->index, iov_size);
732 
733     if (iov_size > cmd->iov_size) {
734         if (megasas_frame_is_ieee_sgl(cmd)) {
735             cmd->frame->dcmd.sgl.sg_skinny->len = cpu_to_le32(iov_size);
736         } else if (megasas_frame_is_sgl64(cmd)) {
737             cmd->frame->dcmd.sgl.sg64->len = cpu_to_le32(iov_size);
738         } else {
739             cmd->frame->dcmd.sgl.sg32->len = cpu_to_le32(iov_size);
740         }
741     }
742 }
743 
744 static int megasas_ctrl_get_info(MegasasState *s, MegasasCmd *cmd)
745 {
746     PCIDevice *pci_dev = PCI_DEVICE(s);
747     PCIDeviceClass *pci_class = PCI_DEVICE_GET_CLASS(pci_dev);
748     MegasasBaseClass *base_class = MEGASAS_GET_CLASS(s);
749     struct mfi_ctrl_info info;
750     size_t dcmd_size = sizeof(info);
751     BusChild *kid;
752     int num_pd_disks = 0;
753 
754     memset(&info, 0x0, dcmd_size);
755     if (cmd->iov_size < dcmd_size) {
756         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
757                                             dcmd_size);
758         return MFI_STAT_INVALID_PARAMETER;
759     }
760 
761     info.pci.vendor = cpu_to_le16(pci_class->vendor_id);
762     info.pci.device = cpu_to_le16(pci_class->device_id);
763     info.pci.subvendor = cpu_to_le16(pci_class->subsystem_vendor_id);
764     info.pci.subdevice = cpu_to_le16(pci_class->subsystem_id);
765 
766     /*
767      * For some reason the firmware supports
768      * only up to 8 device ports.
769      * Despite supporting a far larger number
770      * of devices for the physical devices.
771      * So just display the first 8 devices
772      * in the device port list, independent
773      * of how many logical devices are actually
774      * present.
775      */
776     info.host.type = MFI_INFO_HOST_PCIE;
777     info.device.type = MFI_INFO_DEV_SAS3G;
778     info.device.port_count = 8;
779     QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
780         SCSIDevice *sdev = SCSI_DEVICE(kid->child);
781         uint16_t pd_id;
782 
783         if (num_pd_disks < 8) {
784             pd_id = ((sdev->id & 0xFF) << 8) | (sdev->lun & 0xFF);
785             info.device.port_addr[num_pd_disks] =
786                 cpu_to_le64(megasas_get_sata_addr(pd_id));
787         }
788         num_pd_disks++;
789     }
790 
791     memcpy(info.product_name, base_class->product_name, 24);
792     snprintf(info.serial_number, 32, "%s", s->hba_serial);
793     snprintf(info.package_version, 0x60, "%s-QEMU", qemu_hw_version());
794     memcpy(info.image_component[0].name, "APP", 3);
795     snprintf(info.image_component[0].version, 10, "%s-QEMU",
796              base_class->product_version);
797     memcpy(info.image_component[0].build_date, "Apr  1 2014", 11);
798     memcpy(info.image_component[0].build_time, "12:34:56", 8);
799     info.image_component_count = 1;
800     if (pci_dev->has_rom) {
801         uint8_t biosver[32];
802         uint8_t *ptr;
803 
804         ptr = memory_region_get_ram_ptr(&pci_dev->rom);
805         memcpy(biosver, ptr + 0x41, 31);
806         biosver[31] = 0;
807         memcpy(info.image_component[1].name, "BIOS", 4);
808         memcpy(info.image_component[1].version, biosver,
809                strlen((const char *)biosver));
810         info.image_component_count++;
811     }
812     info.current_fw_time = cpu_to_le32(megasas_fw_time());
813     info.max_arms = 32;
814     info.max_spans = 8;
815     info.max_arrays = MEGASAS_MAX_ARRAYS;
816     info.max_lds = MFI_MAX_LD;
817     info.max_cmds = cpu_to_le16(s->fw_cmds);
818     info.max_sg_elements = cpu_to_le16(s->fw_sge);
819     info.max_request_size = cpu_to_le32(MEGASAS_MAX_SECTORS);
820     if (!megasas_is_jbod(s))
821         info.lds_present = cpu_to_le16(num_pd_disks);
822     info.pd_present = cpu_to_le16(num_pd_disks);
823     info.pd_disks_present = cpu_to_le16(num_pd_disks);
824     info.hw_present = cpu_to_le32(MFI_INFO_HW_NVRAM |
825                                    MFI_INFO_HW_MEM |
826                                    MFI_INFO_HW_FLASH);
827     info.memory_size = cpu_to_le16(512);
828     info.nvram_size = cpu_to_le16(32);
829     info.flash_size = cpu_to_le16(16);
830     info.raid_levels = cpu_to_le32(MFI_INFO_RAID_0);
831     info.adapter_ops = cpu_to_le32(MFI_INFO_AOPS_RBLD_RATE |
832                                     MFI_INFO_AOPS_SELF_DIAGNOSTIC |
833                                     MFI_INFO_AOPS_MIXED_ARRAY);
834     info.ld_ops = cpu_to_le32(MFI_INFO_LDOPS_DISK_CACHE_POLICY |
835                                MFI_INFO_LDOPS_ACCESS_POLICY |
836                                MFI_INFO_LDOPS_IO_POLICY |
837                                MFI_INFO_LDOPS_WRITE_POLICY |
838                                MFI_INFO_LDOPS_READ_POLICY);
839     info.max_strips_per_io = cpu_to_le16(s->fw_sge);
840     info.stripe_sz_ops.min = 3;
841     info.stripe_sz_ops.max = ctz32(MEGASAS_MAX_SECTORS + 1);
842     info.properties.pred_fail_poll_interval = cpu_to_le16(300);
843     info.properties.intr_throttle_cnt = cpu_to_le16(16);
844     info.properties.intr_throttle_timeout = cpu_to_le16(50);
845     info.properties.rebuild_rate = 30;
846     info.properties.patrol_read_rate = 30;
847     info.properties.bgi_rate = 30;
848     info.properties.cc_rate = 30;
849     info.properties.recon_rate = 30;
850     info.properties.cache_flush_interval = 4;
851     info.properties.spinup_drv_cnt = 2;
852     info.properties.spinup_delay = 6;
853     info.properties.ecc_bucket_size = 15;
854     info.properties.ecc_bucket_leak_rate = cpu_to_le16(1440);
855     info.properties.expose_encl_devices = 1;
856     info.properties.OnOffProperties = cpu_to_le32(MFI_CTRL_PROP_EnableJBOD);
857     info.pd_ops = cpu_to_le32(MFI_INFO_PDOPS_FORCE_ONLINE |
858                                MFI_INFO_PDOPS_FORCE_OFFLINE);
859     info.pd_mix_support = cpu_to_le32(MFI_INFO_PDMIX_SAS |
860                                        MFI_INFO_PDMIX_SATA |
861                                        MFI_INFO_PDMIX_LD);
862 
863     cmd->iov_size -= dma_buf_read(&info, dcmd_size, &cmd->qsg, MEMTXATTRS_UNSPECIFIED);
864     return MFI_STAT_OK;
865 }
866 
867 static int megasas_mfc_get_defaults(MegasasState *s, MegasasCmd *cmd)
868 {
869     struct mfi_defaults info;
870     size_t dcmd_size = sizeof(struct mfi_defaults);
871 
872     memset(&info, 0x0, dcmd_size);
873     if (cmd->iov_size < dcmd_size) {
874         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
875                                             dcmd_size);
876         return MFI_STAT_INVALID_PARAMETER;
877     }
878 
879     info.sas_addr = cpu_to_le64(s->sas_addr);
880     info.stripe_size = 3;
881     info.flush_time = 4;
882     info.background_rate = 30;
883     info.allow_mix_in_enclosure = 1;
884     info.allow_mix_in_ld = 1;
885     info.direct_pd_mapping = 1;
886     /* Enable for BIOS support */
887     info.bios_enumerate_lds = 1;
888     info.disable_ctrl_r = 1;
889     info.expose_enclosure_devices = 1;
890     info.disable_preboot_cli = 1;
891     info.cluster_disable = 1;
892 
893     cmd->iov_size -= dma_buf_read(&info, dcmd_size, &cmd->qsg, MEMTXATTRS_UNSPECIFIED);
894     return MFI_STAT_OK;
895 }
896 
897 static int megasas_dcmd_get_bios_info(MegasasState *s, MegasasCmd *cmd)
898 {
899     struct mfi_bios_data info;
900     size_t dcmd_size = sizeof(info);
901 
902     memset(&info, 0x0, dcmd_size);
903     if (cmd->iov_size < dcmd_size) {
904         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
905                                             dcmd_size);
906         return MFI_STAT_INVALID_PARAMETER;
907     }
908     info.continue_on_error = 1;
909     info.verbose = 1;
910     if (megasas_is_jbod(s)) {
911         info.expose_all_drives = 1;
912     }
913 
914     cmd->iov_size -= dma_buf_read(&info, dcmd_size, &cmd->qsg, MEMTXATTRS_UNSPECIFIED);
915     return MFI_STAT_OK;
916 }
917 
918 static int megasas_dcmd_get_fw_time(MegasasState *s, MegasasCmd *cmd)
919 {
920     uint64_t fw_time;
921     size_t dcmd_size = sizeof(fw_time);
922 
923     fw_time = cpu_to_le64(megasas_fw_time());
924 
925     cmd->iov_size -= dma_buf_read(&fw_time, dcmd_size, &cmd->qsg, MEMTXATTRS_UNSPECIFIED);
926     return MFI_STAT_OK;
927 }
928 
929 static int megasas_dcmd_set_fw_time(MegasasState *s, MegasasCmd *cmd)
930 {
931     uint64_t fw_time;
932 
933     /* This is a dummy; setting of firmware time is not allowed */
934     memcpy(&fw_time, cmd->frame->dcmd.mbox, sizeof(fw_time));
935 
936     trace_megasas_dcmd_set_fw_time(cmd->index, fw_time);
937     fw_time = cpu_to_le64(megasas_fw_time());
938     return MFI_STAT_OK;
939 }
940 
941 static int megasas_event_info(MegasasState *s, MegasasCmd *cmd)
942 {
943     struct mfi_evt_log_state info;
944     size_t dcmd_size = sizeof(info);
945 
946     memset(&info, 0, dcmd_size);
947 
948     info.newest_seq_num = cpu_to_le32(s->event_count);
949     info.shutdown_seq_num = cpu_to_le32(s->shutdown_event);
950     info.boot_seq_num = cpu_to_le32(s->boot_event);
951 
952     cmd->iov_size -= dma_buf_read(&info, dcmd_size, &cmd->qsg, MEMTXATTRS_UNSPECIFIED);
953     return MFI_STAT_OK;
954 }
955 
956 static int megasas_event_wait(MegasasState *s, MegasasCmd *cmd)
957 {
958     union mfi_evt event;
959 
960     if (cmd->iov_size < sizeof(struct mfi_evt_detail)) {
961         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
962                                             sizeof(struct mfi_evt_detail));
963         return MFI_STAT_INVALID_PARAMETER;
964     }
965     s->event_count = cpu_to_le32(cmd->frame->dcmd.mbox[0]);
966     event.word = cpu_to_le32(cmd->frame->dcmd.mbox[4]);
967     s->event_locale = event.members.locale;
968     s->event_class = event.members.class;
969     s->event_cmd = cmd;
970     /* Decrease busy count; event frame doesn't count here */
971     s->busy--;
972     cmd->iov_size = sizeof(struct mfi_evt_detail);
973     return MFI_STAT_INVALID_STATUS;
974 }
975 
976 static int megasas_dcmd_pd_get_list(MegasasState *s, MegasasCmd *cmd)
977 {
978     struct mfi_pd_list info;
979     size_t dcmd_size = sizeof(info);
980     BusChild *kid;
981     uint32_t offset, dcmd_limit, num_pd_disks = 0, max_pd_disks;
982 
983     memset(&info, 0, dcmd_size);
984     offset = 8;
985     dcmd_limit = offset + sizeof(struct mfi_pd_address);
986     if (cmd->iov_size < dcmd_limit) {
987         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
988                                             dcmd_limit);
989         return MFI_STAT_INVALID_PARAMETER;
990     }
991 
992     max_pd_disks = (cmd->iov_size - offset) / sizeof(struct mfi_pd_address);
993     if (max_pd_disks > MFI_MAX_SYS_PDS) {
994         max_pd_disks = MFI_MAX_SYS_PDS;
995     }
996     QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
997         SCSIDevice *sdev = SCSI_DEVICE(kid->child);
998         uint16_t pd_id;
999 
1000         if (num_pd_disks >= max_pd_disks)
1001             break;
1002 
1003         pd_id = ((sdev->id & 0xFF) << 8) | (sdev->lun & 0xFF);
1004         info.addr[num_pd_disks].device_id = cpu_to_le16(pd_id);
1005         info.addr[num_pd_disks].encl_device_id = 0xFFFF;
1006         info.addr[num_pd_disks].encl_index = 0;
1007         info.addr[num_pd_disks].slot_number = sdev->id & 0xFF;
1008         info.addr[num_pd_disks].scsi_dev_type = sdev->type;
1009         info.addr[num_pd_disks].connect_port_bitmap = 0x1;
1010         info.addr[num_pd_disks].sas_addr[0] =
1011             cpu_to_le64(megasas_get_sata_addr(pd_id));
1012         num_pd_disks++;
1013         offset += sizeof(struct mfi_pd_address);
1014     }
1015     trace_megasas_dcmd_pd_get_list(cmd->index, num_pd_disks,
1016                                    max_pd_disks, offset);
1017 
1018     info.size = cpu_to_le32(offset);
1019     info.count = cpu_to_le32(num_pd_disks);
1020 
1021     cmd->iov_size -= dma_buf_read(&info, offset, &cmd->qsg, MEMTXATTRS_UNSPECIFIED);
1022     return MFI_STAT_OK;
1023 }
1024 
1025 static int megasas_dcmd_pd_list_query(MegasasState *s, MegasasCmd *cmd)
1026 {
1027     uint16_t flags;
1028 
1029     /* mbox0 contains flags */
1030     flags = le16_to_cpu(cmd->frame->dcmd.mbox[0]);
1031     trace_megasas_dcmd_pd_list_query(cmd->index, flags);
1032     if (flags == MR_PD_QUERY_TYPE_ALL ||
1033         megasas_is_jbod(s)) {
1034         return megasas_dcmd_pd_get_list(s, cmd);
1035     }
1036 
1037     return MFI_STAT_OK;
1038 }
1039 
1040 static int megasas_pd_get_info_submit(SCSIDevice *sdev, int lun,
1041                                       MegasasCmd *cmd)
1042 {
1043     struct mfi_pd_info *info = cmd->iov_buf;
1044     size_t dcmd_size = sizeof(struct mfi_pd_info);
1045     uint64_t pd_size;
1046     uint16_t pd_id = ((sdev->id & 0xFF) << 8) | (lun & 0xFF);
1047     uint8_t cmdbuf[6];
1048     size_t len;
1049     dma_addr_t residual;
1050 
1051     if (!cmd->iov_buf) {
1052         cmd->iov_buf = g_malloc0(dcmd_size);
1053         info = cmd->iov_buf;
1054         info->inquiry_data[0] = 0x7f; /* Force PQual 0x3, PType 0x1f */
1055         info->vpd_page83[0] = 0x7f;
1056         megasas_setup_inquiry(cmdbuf, 0, sizeof(info->inquiry_data));
1057         cmd->req = scsi_req_new(sdev, cmd->index, lun, cmdbuf, cmd);
1058         if (!cmd->req) {
1059             trace_megasas_dcmd_req_alloc_failed(cmd->index,
1060                                                 "PD get info std inquiry");
1061             g_free(cmd->iov_buf);
1062             cmd->iov_buf = NULL;
1063             return MFI_STAT_FLASH_ALLOC_FAIL;
1064         }
1065         trace_megasas_dcmd_internal_submit(cmd->index,
1066                                            "PD get info std inquiry", lun);
1067         len = scsi_req_enqueue(cmd->req);
1068         if (len > 0) {
1069             cmd->iov_size = len;
1070             scsi_req_continue(cmd->req);
1071         }
1072         return MFI_STAT_INVALID_STATUS;
1073     } else if (info->inquiry_data[0] != 0x7f && info->vpd_page83[0] == 0x7f) {
1074         megasas_setup_inquiry(cmdbuf, 0x83, sizeof(info->vpd_page83));
1075         cmd->req = scsi_req_new(sdev, cmd->index, lun, cmdbuf, cmd);
1076         if (!cmd->req) {
1077             trace_megasas_dcmd_req_alloc_failed(cmd->index,
1078                                                 "PD get info vpd inquiry");
1079             return MFI_STAT_FLASH_ALLOC_FAIL;
1080         }
1081         trace_megasas_dcmd_internal_submit(cmd->index,
1082                                            "PD get info vpd inquiry", lun);
1083         len = scsi_req_enqueue(cmd->req);
1084         if (len > 0) {
1085             cmd->iov_size = len;
1086             scsi_req_continue(cmd->req);
1087         }
1088         return MFI_STAT_INVALID_STATUS;
1089     }
1090     /* Finished, set FW state */
1091     if ((info->inquiry_data[0] >> 5) == 0) {
1092         if (megasas_is_jbod(cmd->state)) {
1093             info->fw_state = cpu_to_le16(MFI_PD_STATE_SYSTEM);
1094         } else {
1095             info->fw_state = cpu_to_le16(MFI_PD_STATE_ONLINE);
1096         }
1097     } else {
1098         info->fw_state = cpu_to_le16(MFI_PD_STATE_OFFLINE);
1099     }
1100 
1101     info->ref.v.device_id = cpu_to_le16(pd_id);
1102     info->state.ddf.pd_type = cpu_to_le16(MFI_PD_DDF_TYPE_IN_VD|
1103                                           MFI_PD_DDF_TYPE_INTF_SAS);
1104     blk_get_geometry(sdev->conf.blk, &pd_size);
1105     info->raw_size = cpu_to_le64(pd_size);
1106     info->non_coerced_size = cpu_to_le64(pd_size);
1107     info->coerced_size = cpu_to_le64(pd_size);
1108     info->encl_device_id = 0xFFFF;
1109     info->slot_number = (sdev->id & 0xFF);
1110     info->path_info.count = 1;
1111     info->path_info.sas_addr[0] =
1112         cpu_to_le64(megasas_get_sata_addr(pd_id));
1113     info->connected_port_bitmap = 0x1;
1114     info->device_speed = 1;
1115     info->link_speed = 1;
1116     residual = dma_buf_read(cmd->iov_buf, dcmd_size, &cmd->qsg,
1117                             MEMTXATTRS_UNSPECIFIED);
1118     g_free(cmd->iov_buf);
1119     cmd->iov_size = dcmd_size - residual;
1120     cmd->iov_buf = NULL;
1121     return MFI_STAT_OK;
1122 }
1123 
1124 static int megasas_dcmd_pd_get_info(MegasasState *s, MegasasCmd *cmd)
1125 {
1126     size_t dcmd_size = sizeof(struct mfi_pd_info);
1127     uint16_t pd_id;
1128     uint8_t target_id, lun_id;
1129     SCSIDevice *sdev = NULL;
1130     int retval = MFI_STAT_DEVICE_NOT_FOUND;
1131 
1132     if (cmd->iov_size < dcmd_size) {
1133         return MFI_STAT_INVALID_PARAMETER;
1134     }
1135 
1136     /* mbox0 has the ID */
1137     pd_id = le16_to_cpu(cmd->frame->dcmd.mbox[0]);
1138     target_id = (pd_id >> 8) & 0xFF;
1139     lun_id = pd_id & 0xFF;
1140     sdev = scsi_device_find(&s->bus, 0, target_id, lun_id);
1141     trace_megasas_dcmd_pd_get_info(cmd->index, pd_id);
1142 
1143     if (sdev) {
1144         /* Submit inquiry */
1145         retval = megasas_pd_get_info_submit(sdev, pd_id, cmd);
1146     }
1147 
1148     return retval;
1149 }
1150 
1151 static int megasas_dcmd_ld_get_list(MegasasState *s, MegasasCmd *cmd)
1152 {
1153     struct mfi_ld_list info;
1154     size_t dcmd_size = sizeof(info);
1155     dma_addr_t residual;
1156     uint32_t num_ld_disks = 0, max_ld_disks;
1157     uint64_t ld_size;
1158     BusChild *kid;
1159 
1160     memset(&info, 0, dcmd_size);
1161     if (cmd->iov_size > dcmd_size) {
1162         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
1163                                             dcmd_size);
1164         return MFI_STAT_INVALID_PARAMETER;
1165     }
1166 
1167     max_ld_disks = (cmd->iov_size - 8) / 16;
1168     if (megasas_is_jbod(s)) {
1169         max_ld_disks = 0;
1170     }
1171     if (max_ld_disks > MFI_MAX_LD) {
1172         max_ld_disks = MFI_MAX_LD;
1173     }
1174     QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
1175         SCSIDevice *sdev = SCSI_DEVICE(kid->child);
1176 
1177         if (num_ld_disks >= max_ld_disks) {
1178             break;
1179         }
1180         /* Logical device size is in blocks */
1181         blk_get_geometry(sdev->conf.blk, &ld_size);
1182         info.ld_list[num_ld_disks].ld.v.target_id = sdev->id;
1183         info.ld_list[num_ld_disks].state = MFI_LD_STATE_OPTIMAL;
1184         info.ld_list[num_ld_disks].size = cpu_to_le64(ld_size);
1185         num_ld_disks++;
1186     }
1187     info.ld_count = cpu_to_le32(num_ld_disks);
1188     trace_megasas_dcmd_ld_get_list(cmd->index, num_ld_disks, max_ld_disks);
1189 
1190     residual = dma_buf_read(&info, dcmd_size, &cmd->qsg,
1191                             MEMTXATTRS_UNSPECIFIED);
1192     cmd->iov_size = dcmd_size - residual;
1193     return MFI_STAT_OK;
1194 }
1195 
1196 static int megasas_dcmd_ld_list_query(MegasasState *s, MegasasCmd *cmd)
1197 {
1198     uint16_t flags;
1199     struct mfi_ld_targetid_list info;
1200     size_t dcmd_size = sizeof(info);
1201     dma_addr_t residual;
1202     uint32_t num_ld_disks = 0, max_ld_disks = s->fw_luns;
1203     BusChild *kid;
1204 
1205     /* mbox0 contains flags */
1206     flags = le16_to_cpu(cmd->frame->dcmd.mbox[0]);
1207     trace_megasas_dcmd_ld_list_query(cmd->index, flags);
1208     if (flags != MR_LD_QUERY_TYPE_ALL &&
1209         flags != MR_LD_QUERY_TYPE_EXPOSED_TO_HOST) {
1210         max_ld_disks = 0;
1211     }
1212 
1213     memset(&info, 0, dcmd_size);
1214     if (cmd->iov_size < 12) {
1215         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
1216                                             dcmd_size);
1217         return MFI_STAT_INVALID_PARAMETER;
1218     }
1219     dcmd_size = sizeof(uint32_t) * 2 + 3;
1220     max_ld_disks = cmd->iov_size - dcmd_size;
1221     if (megasas_is_jbod(s)) {
1222         max_ld_disks = 0;
1223     }
1224     if (max_ld_disks > MFI_MAX_LD) {
1225         max_ld_disks = MFI_MAX_LD;
1226     }
1227     QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
1228         SCSIDevice *sdev = SCSI_DEVICE(kid->child);
1229 
1230         if (num_ld_disks >= max_ld_disks) {
1231             break;
1232         }
1233         info.targetid[num_ld_disks] = sdev->lun;
1234         num_ld_disks++;
1235         dcmd_size++;
1236     }
1237     info.ld_count = cpu_to_le32(num_ld_disks);
1238     info.size = dcmd_size;
1239     trace_megasas_dcmd_ld_get_list(cmd->index, num_ld_disks, max_ld_disks);
1240 
1241     residual = dma_buf_read(&info, dcmd_size, &cmd->qsg,
1242                             MEMTXATTRS_UNSPECIFIED);
1243     cmd->iov_size = dcmd_size - residual;
1244     return MFI_STAT_OK;
1245 }
1246 
1247 static int megasas_ld_get_info_submit(SCSIDevice *sdev, int lun,
1248                                       MegasasCmd *cmd)
1249 {
1250     struct mfi_ld_info *info = cmd->iov_buf;
1251     size_t dcmd_size = sizeof(struct mfi_ld_info);
1252     uint8_t cdb[6];
1253     ssize_t len;
1254     dma_addr_t residual;
1255     uint16_t sdev_id = ((sdev->id & 0xFF) << 8) | (lun & 0xFF);
1256     uint64_t ld_size;
1257 
1258     if (!cmd->iov_buf) {
1259         cmd->iov_buf = g_malloc0(dcmd_size);
1260         info = cmd->iov_buf;
1261         megasas_setup_inquiry(cdb, 0x83, sizeof(info->vpd_page83));
1262         cmd->req = scsi_req_new(sdev, cmd->index, lun, cdb, cmd);
1263         if (!cmd->req) {
1264             trace_megasas_dcmd_req_alloc_failed(cmd->index,
1265                                                 "LD get info vpd inquiry");
1266             g_free(cmd->iov_buf);
1267             cmd->iov_buf = NULL;
1268             return MFI_STAT_FLASH_ALLOC_FAIL;
1269         }
1270         trace_megasas_dcmd_internal_submit(cmd->index,
1271                                            "LD get info vpd inquiry", lun);
1272         len = scsi_req_enqueue(cmd->req);
1273         if (len > 0) {
1274             cmd->iov_size = len;
1275             scsi_req_continue(cmd->req);
1276         }
1277         return MFI_STAT_INVALID_STATUS;
1278     }
1279 
1280     info->ld_config.params.state = MFI_LD_STATE_OPTIMAL;
1281     info->ld_config.properties.ld.v.target_id = lun;
1282     info->ld_config.params.stripe_size = 3;
1283     info->ld_config.params.num_drives = 1;
1284     info->ld_config.params.is_consistent = 1;
1285     /* Logical device size is in blocks */
1286     blk_get_geometry(sdev->conf.blk, &ld_size);
1287     info->size = cpu_to_le64(ld_size);
1288     memset(info->ld_config.span, 0, sizeof(info->ld_config.span));
1289     info->ld_config.span[0].start_block = 0;
1290     info->ld_config.span[0].num_blocks = info->size;
1291     info->ld_config.span[0].array_ref = cpu_to_le16(sdev_id);
1292 
1293     residual = dma_buf_read(cmd->iov_buf, dcmd_size, &cmd->qsg,
1294                             MEMTXATTRS_UNSPECIFIED);
1295     g_free(cmd->iov_buf);
1296     cmd->iov_size = dcmd_size - residual;
1297     cmd->iov_buf = NULL;
1298     return MFI_STAT_OK;
1299 }
1300 
1301 static int megasas_dcmd_ld_get_info(MegasasState *s, MegasasCmd *cmd)
1302 {
1303     struct mfi_ld_info info;
1304     size_t dcmd_size = sizeof(info);
1305     uint16_t ld_id;
1306     uint32_t max_ld_disks = s->fw_luns;
1307     SCSIDevice *sdev = NULL;
1308     int retval = MFI_STAT_DEVICE_NOT_FOUND;
1309 
1310     if (cmd->iov_size < dcmd_size) {
1311         return MFI_STAT_INVALID_PARAMETER;
1312     }
1313 
1314     /* mbox0 has the ID */
1315     ld_id = le16_to_cpu(cmd->frame->dcmd.mbox[0]);
1316     trace_megasas_dcmd_ld_get_info(cmd->index, ld_id);
1317 
1318     if (megasas_is_jbod(s)) {
1319         return MFI_STAT_DEVICE_NOT_FOUND;
1320     }
1321 
1322     if (ld_id < max_ld_disks) {
1323         sdev = scsi_device_find(&s->bus, 0, ld_id, 0);
1324     }
1325 
1326     if (sdev) {
1327         retval = megasas_ld_get_info_submit(sdev, ld_id, cmd);
1328     }
1329 
1330     return retval;
1331 }
1332 
1333 static int megasas_dcmd_cfg_read(MegasasState *s, MegasasCmd *cmd)
1334 {
1335     uint8_t data[4096] = { 0 };
1336     struct mfi_config_data *info;
1337     int num_pd_disks = 0, array_offset, ld_offset;
1338     BusChild *kid;
1339 
1340     if (cmd->iov_size > 4096) {
1341         return MFI_STAT_INVALID_PARAMETER;
1342     }
1343 
1344     QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
1345         num_pd_disks++;
1346     }
1347     info = (struct mfi_config_data *)&data;
1348     /*
1349      * Array mapping:
1350      * - One array per SCSI device
1351      * - One logical drive per SCSI device
1352      *   spanning the entire device
1353      */
1354     info->array_count = num_pd_disks;
1355     info->array_size = sizeof(struct mfi_array) * num_pd_disks;
1356     info->log_drv_count = num_pd_disks;
1357     info->log_drv_size = sizeof(struct mfi_ld_config) * num_pd_disks;
1358     info->spares_count = 0;
1359     info->spares_size = sizeof(struct mfi_spare);
1360     info->size = sizeof(struct mfi_config_data) + info->array_size +
1361         info->log_drv_size;
1362     if (info->size > 4096) {
1363         return MFI_STAT_INVALID_PARAMETER;
1364     }
1365 
1366     array_offset = sizeof(struct mfi_config_data);
1367     ld_offset = array_offset + sizeof(struct mfi_array) * num_pd_disks;
1368 
1369     QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
1370         SCSIDevice *sdev = SCSI_DEVICE(kid->child);
1371         uint16_t sdev_id = ((sdev->id & 0xFF) << 8) | (sdev->lun & 0xFF);
1372         struct mfi_array *array;
1373         struct mfi_ld_config *ld;
1374         uint64_t pd_size;
1375         int i;
1376 
1377         array = (struct mfi_array *)(data + array_offset);
1378         blk_get_geometry(sdev->conf.blk, &pd_size);
1379         array->size = cpu_to_le64(pd_size);
1380         array->num_drives = 1;
1381         array->array_ref = cpu_to_le16(sdev_id);
1382         array->pd[0].ref.v.device_id = cpu_to_le16(sdev_id);
1383         array->pd[0].ref.v.seq_num = 0;
1384         array->pd[0].fw_state = MFI_PD_STATE_ONLINE;
1385         array->pd[0].encl.pd = 0xFF;
1386         array->pd[0].encl.slot = (sdev->id & 0xFF);
1387         for (i = 1; i < MFI_MAX_ROW_SIZE; i++) {
1388             array->pd[i].ref.v.device_id = 0xFFFF;
1389             array->pd[i].ref.v.seq_num = 0;
1390             array->pd[i].fw_state = MFI_PD_STATE_UNCONFIGURED_GOOD;
1391             array->pd[i].encl.pd = 0xFF;
1392             array->pd[i].encl.slot = 0xFF;
1393         }
1394         array_offset += sizeof(struct mfi_array);
1395         ld = (struct mfi_ld_config *)(data + ld_offset);
1396         memset(ld, 0, sizeof(struct mfi_ld_config));
1397         ld->properties.ld.v.target_id = sdev->id;
1398         ld->properties.default_cache_policy = MR_LD_CACHE_READ_AHEAD |
1399             MR_LD_CACHE_READ_ADAPTIVE;
1400         ld->properties.current_cache_policy = MR_LD_CACHE_READ_AHEAD |
1401             MR_LD_CACHE_READ_ADAPTIVE;
1402         ld->params.state = MFI_LD_STATE_OPTIMAL;
1403         ld->params.stripe_size = 3;
1404         ld->params.num_drives = 1;
1405         ld->params.span_depth = 1;
1406         ld->params.is_consistent = 1;
1407         ld->span[0].start_block = 0;
1408         ld->span[0].num_blocks = cpu_to_le64(pd_size);
1409         ld->span[0].array_ref = cpu_to_le16(sdev_id);
1410         ld_offset += sizeof(struct mfi_ld_config);
1411     }
1412 
1413     cmd->iov_size -= dma_buf_read(data, info->size, &cmd->qsg, MEMTXATTRS_UNSPECIFIED);
1414     return MFI_STAT_OK;
1415 }
1416 
1417 static int megasas_dcmd_get_properties(MegasasState *s, MegasasCmd *cmd)
1418 {
1419     struct mfi_ctrl_props info;
1420     size_t dcmd_size = sizeof(info);
1421 
1422     memset(&info, 0x0, dcmd_size);
1423     if (cmd->iov_size < dcmd_size) {
1424         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
1425                                             dcmd_size);
1426         return MFI_STAT_INVALID_PARAMETER;
1427     }
1428     info.pred_fail_poll_interval = cpu_to_le16(300);
1429     info.intr_throttle_cnt = cpu_to_le16(16);
1430     info.intr_throttle_timeout = cpu_to_le16(50);
1431     info.rebuild_rate = 30;
1432     info.patrol_read_rate = 30;
1433     info.bgi_rate = 30;
1434     info.cc_rate = 30;
1435     info.recon_rate = 30;
1436     info.cache_flush_interval = 4;
1437     info.spinup_drv_cnt = 2;
1438     info.spinup_delay = 6;
1439     info.ecc_bucket_size = 15;
1440     info.ecc_bucket_leak_rate = cpu_to_le16(1440);
1441     info.expose_encl_devices = 1;
1442 
1443     cmd->iov_size -= dma_buf_read(&info, dcmd_size, &cmd->qsg, MEMTXATTRS_UNSPECIFIED);
1444     return MFI_STAT_OK;
1445 }
1446 
1447 static int megasas_cache_flush(MegasasState *s, MegasasCmd *cmd)
1448 {
1449     blk_drain_all();
1450     return MFI_STAT_OK;
1451 }
1452 
1453 static int megasas_ctrl_shutdown(MegasasState *s, MegasasCmd *cmd)
1454 {
1455     s->fw_state = MFI_FWSTATE_READY;
1456     return MFI_STAT_OK;
1457 }
1458 
1459 /* Some implementations use CLUSTER RESET LD to simulate a device reset */
1460 static int megasas_cluster_reset_ld(MegasasState *s, MegasasCmd *cmd)
1461 {
1462     uint16_t target_id;
1463     int i;
1464 
1465     /* mbox0 contains the device index */
1466     target_id = le16_to_cpu(cmd->frame->dcmd.mbox[0]);
1467     trace_megasas_dcmd_reset_ld(cmd->index, target_id);
1468     for (i = 0; i < s->fw_cmds; i++) {
1469         MegasasCmd *tmp_cmd = &s->frames[i];
1470         if (tmp_cmd->req && tmp_cmd->req->dev->id == target_id) {
1471             SCSIDevice *d = tmp_cmd->req->dev;
1472             qdev_reset_all(&d->qdev);
1473         }
1474     }
1475     return MFI_STAT_OK;
1476 }
1477 
1478 static int megasas_dcmd_set_properties(MegasasState *s, MegasasCmd *cmd)
1479 {
1480     struct mfi_ctrl_props info;
1481     size_t dcmd_size = sizeof(info);
1482 
1483     if (cmd->iov_size < dcmd_size) {
1484         trace_megasas_dcmd_invalid_xfer_len(cmd->index, cmd->iov_size,
1485                                             dcmd_size);
1486         return MFI_STAT_INVALID_PARAMETER;
1487     }
1488     dma_buf_write(&info, dcmd_size, &cmd->qsg, MEMTXATTRS_UNSPECIFIED);
1489     trace_megasas_dcmd_unsupported(cmd->index, cmd->iov_size);
1490     return MFI_STAT_OK;
1491 }
1492 
1493 static int megasas_dcmd_dummy(MegasasState *s, MegasasCmd *cmd)
1494 {
1495     trace_megasas_dcmd_dummy(cmd->index, cmd->iov_size);
1496     return MFI_STAT_OK;
1497 }
1498 
1499 static const struct dcmd_cmd_tbl_t {
1500     int opcode;
1501     const char *desc;
1502     int (*func)(MegasasState *s, MegasasCmd *cmd);
1503 } dcmd_cmd_tbl[] = {
1504     { MFI_DCMD_CTRL_MFI_HOST_MEM_ALLOC, "CTRL_HOST_MEM_ALLOC",
1505       megasas_dcmd_dummy },
1506     { MFI_DCMD_CTRL_GET_INFO, "CTRL_GET_INFO",
1507       megasas_ctrl_get_info },
1508     { MFI_DCMD_CTRL_GET_PROPERTIES, "CTRL_GET_PROPERTIES",
1509       megasas_dcmd_get_properties },
1510     { MFI_DCMD_CTRL_SET_PROPERTIES, "CTRL_SET_PROPERTIES",
1511       megasas_dcmd_set_properties },
1512     { MFI_DCMD_CTRL_ALARM_GET, "CTRL_ALARM_GET",
1513       megasas_dcmd_dummy },
1514     { MFI_DCMD_CTRL_ALARM_ENABLE, "CTRL_ALARM_ENABLE",
1515       megasas_dcmd_dummy },
1516     { MFI_DCMD_CTRL_ALARM_DISABLE, "CTRL_ALARM_DISABLE",
1517       megasas_dcmd_dummy },
1518     { MFI_DCMD_CTRL_ALARM_SILENCE, "CTRL_ALARM_SILENCE",
1519       megasas_dcmd_dummy },
1520     { MFI_DCMD_CTRL_ALARM_TEST, "CTRL_ALARM_TEST",
1521       megasas_dcmd_dummy },
1522     { MFI_DCMD_CTRL_EVENT_GETINFO, "CTRL_EVENT_GETINFO",
1523       megasas_event_info },
1524     { MFI_DCMD_CTRL_EVENT_GET, "CTRL_EVENT_GET",
1525       megasas_dcmd_dummy },
1526     { MFI_DCMD_CTRL_EVENT_WAIT, "CTRL_EVENT_WAIT",
1527       megasas_event_wait },
1528     { MFI_DCMD_CTRL_SHUTDOWN, "CTRL_SHUTDOWN",
1529       megasas_ctrl_shutdown },
1530     { MFI_DCMD_HIBERNATE_STANDBY, "CTRL_STANDBY",
1531       megasas_dcmd_dummy },
1532     { MFI_DCMD_CTRL_GET_TIME, "CTRL_GET_TIME",
1533       megasas_dcmd_get_fw_time },
1534     { MFI_DCMD_CTRL_SET_TIME, "CTRL_SET_TIME",
1535       megasas_dcmd_set_fw_time },
1536     { MFI_DCMD_CTRL_BIOS_DATA_GET, "CTRL_BIOS_DATA_GET",
1537       megasas_dcmd_get_bios_info },
1538     { MFI_DCMD_CTRL_FACTORY_DEFAULTS, "CTRL_FACTORY_DEFAULTS",
1539       megasas_dcmd_dummy },
1540     { MFI_DCMD_CTRL_MFC_DEFAULTS_GET, "CTRL_MFC_DEFAULTS_GET",
1541       megasas_mfc_get_defaults },
1542     { MFI_DCMD_CTRL_MFC_DEFAULTS_SET, "CTRL_MFC_DEFAULTS_SET",
1543       megasas_dcmd_dummy },
1544     { MFI_DCMD_CTRL_CACHE_FLUSH, "CTRL_CACHE_FLUSH",
1545       megasas_cache_flush },
1546     { MFI_DCMD_PD_GET_LIST, "PD_GET_LIST",
1547       megasas_dcmd_pd_get_list },
1548     { MFI_DCMD_PD_LIST_QUERY, "PD_LIST_QUERY",
1549       megasas_dcmd_pd_list_query },
1550     { MFI_DCMD_PD_GET_INFO, "PD_GET_INFO",
1551       megasas_dcmd_pd_get_info },
1552     { MFI_DCMD_PD_STATE_SET, "PD_STATE_SET",
1553       megasas_dcmd_dummy },
1554     { MFI_DCMD_PD_REBUILD, "PD_REBUILD",
1555       megasas_dcmd_dummy },
1556     { MFI_DCMD_PD_BLINK, "PD_BLINK",
1557       megasas_dcmd_dummy },
1558     { MFI_DCMD_PD_UNBLINK, "PD_UNBLINK",
1559       megasas_dcmd_dummy },
1560     { MFI_DCMD_LD_GET_LIST, "LD_GET_LIST",
1561       megasas_dcmd_ld_get_list},
1562     { MFI_DCMD_LD_LIST_QUERY, "LD_LIST_QUERY",
1563       megasas_dcmd_ld_list_query },
1564     { MFI_DCMD_LD_GET_INFO, "LD_GET_INFO",
1565       megasas_dcmd_ld_get_info },
1566     { MFI_DCMD_LD_GET_PROP, "LD_GET_PROP",
1567       megasas_dcmd_dummy },
1568     { MFI_DCMD_LD_SET_PROP, "LD_SET_PROP",
1569       megasas_dcmd_dummy },
1570     { MFI_DCMD_LD_DELETE, "LD_DELETE",
1571       megasas_dcmd_dummy },
1572     { MFI_DCMD_CFG_READ, "CFG_READ",
1573       megasas_dcmd_cfg_read },
1574     { MFI_DCMD_CFG_ADD, "CFG_ADD",
1575       megasas_dcmd_dummy },
1576     { MFI_DCMD_CFG_CLEAR, "CFG_CLEAR",
1577       megasas_dcmd_dummy },
1578     { MFI_DCMD_CFG_FOREIGN_READ, "CFG_FOREIGN_READ",
1579       megasas_dcmd_dummy },
1580     { MFI_DCMD_CFG_FOREIGN_IMPORT, "CFG_FOREIGN_IMPORT",
1581       megasas_dcmd_dummy },
1582     { MFI_DCMD_BBU_STATUS, "BBU_STATUS",
1583       megasas_dcmd_dummy },
1584     { MFI_DCMD_BBU_CAPACITY_INFO, "BBU_CAPACITY_INFO",
1585       megasas_dcmd_dummy },
1586     { MFI_DCMD_BBU_DESIGN_INFO, "BBU_DESIGN_INFO",
1587       megasas_dcmd_dummy },
1588     { MFI_DCMD_BBU_PROP_GET, "BBU_PROP_GET",
1589       megasas_dcmd_dummy },
1590     { MFI_DCMD_CLUSTER, "CLUSTER",
1591       megasas_dcmd_dummy },
1592     { MFI_DCMD_CLUSTER_RESET_ALL, "CLUSTER_RESET_ALL",
1593       megasas_dcmd_dummy },
1594     { MFI_DCMD_CLUSTER_RESET_LD, "CLUSTER_RESET_LD",
1595       megasas_cluster_reset_ld },
1596     { -1, NULL, NULL }
1597 };
1598 
1599 static int megasas_handle_dcmd(MegasasState *s, MegasasCmd *cmd)
1600 {
1601     int retval = 0;
1602     size_t len;
1603     const struct dcmd_cmd_tbl_t *cmdptr = dcmd_cmd_tbl;
1604 
1605     cmd->dcmd_opcode = le32_to_cpu(cmd->frame->dcmd.opcode);
1606     trace_megasas_handle_dcmd(cmd->index, cmd->dcmd_opcode);
1607     if (megasas_map_dcmd(s, cmd) < 0) {
1608         return MFI_STAT_MEMORY_NOT_AVAILABLE;
1609     }
1610     while (cmdptr->opcode != -1 && cmdptr->opcode != cmd->dcmd_opcode) {
1611         cmdptr++;
1612     }
1613     len = cmd->iov_size;
1614     if (cmdptr->opcode == -1) {
1615         trace_megasas_dcmd_unhandled(cmd->index, cmd->dcmd_opcode, len);
1616         retval = megasas_dcmd_dummy(s, cmd);
1617     } else {
1618         trace_megasas_dcmd_enter(cmd->index, cmdptr->desc, len);
1619         retval = cmdptr->func(s, cmd);
1620     }
1621     if (retval != MFI_STAT_INVALID_STATUS) {
1622         megasas_finish_dcmd(cmd, len);
1623     }
1624     return retval;
1625 }
1626 
1627 static int megasas_finish_internal_dcmd(MegasasCmd *cmd,
1628                                         SCSIRequest *req, dma_addr_t residual)
1629 {
1630     int retval = MFI_STAT_OK;
1631     int lun = req->lun;
1632 
1633     trace_megasas_dcmd_internal_finish(cmd->index, cmd->dcmd_opcode, lun);
1634     cmd->iov_size -= residual;
1635     switch (cmd->dcmd_opcode) {
1636     case MFI_DCMD_PD_GET_INFO:
1637         retval = megasas_pd_get_info_submit(req->dev, lun, cmd);
1638         break;
1639     case MFI_DCMD_LD_GET_INFO:
1640         retval = megasas_ld_get_info_submit(req->dev, lun, cmd);
1641         break;
1642     default:
1643         trace_megasas_dcmd_internal_invalid(cmd->index, cmd->dcmd_opcode);
1644         retval = MFI_STAT_INVALID_DCMD;
1645         break;
1646     }
1647     if (retval != MFI_STAT_INVALID_STATUS) {
1648         megasas_finish_dcmd(cmd, cmd->iov_size);
1649     }
1650     return retval;
1651 }
1652 
1653 static int megasas_enqueue_req(MegasasCmd *cmd, bool is_write)
1654 {
1655     int len;
1656 
1657     len = scsi_req_enqueue(cmd->req);
1658     if (len < 0) {
1659         len = -len;
1660     }
1661     if (len > 0) {
1662         if (len > cmd->iov_size) {
1663             if (is_write) {
1664                 trace_megasas_iov_write_overflow(cmd->index, len,
1665                                                  cmd->iov_size);
1666             } else {
1667                 trace_megasas_iov_read_overflow(cmd->index, len,
1668                                                 cmd->iov_size);
1669             }
1670         }
1671         if (len < cmd->iov_size) {
1672             if (is_write) {
1673                 trace_megasas_iov_write_underflow(cmd->index, len,
1674                                                   cmd->iov_size);
1675             } else {
1676                 trace_megasas_iov_read_underflow(cmd->index, len,
1677                                                  cmd->iov_size);
1678             }
1679             cmd->iov_size = len;
1680         }
1681         scsi_req_continue(cmd->req);
1682     }
1683     return len;
1684 }
1685 
1686 static int megasas_handle_scsi(MegasasState *s, MegasasCmd *cmd,
1687                                int frame_cmd)
1688 {
1689     uint8_t *cdb;
1690     int target_id, lun_id, cdb_len;
1691     bool is_write;
1692     struct SCSIDevice *sdev = NULL;
1693     bool is_logical = (frame_cmd == MFI_CMD_LD_SCSI_IO);
1694 
1695     cdb = cmd->frame->pass.cdb;
1696     target_id = cmd->frame->header.target_id;
1697     lun_id = cmd->frame->header.lun_id;
1698     cdb_len = cmd->frame->header.cdb_len;
1699 
1700     if (is_logical) {
1701         if (target_id >= MFI_MAX_LD || lun_id != 0) {
1702             trace_megasas_scsi_target_not_present(
1703                 mfi_frame_desc(frame_cmd), is_logical, target_id, lun_id);
1704             return MFI_STAT_DEVICE_NOT_FOUND;
1705         }
1706     }
1707     sdev = scsi_device_find(&s->bus, 0, target_id, lun_id);
1708 
1709     cmd->iov_size = le32_to_cpu(cmd->frame->header.data_len);
1710     trace_megasas_handle_scsi(mfi_frame_desc(frame_cmd), is_logical,
1711                               target_id, lun_id, sdev, cmd->iov_size);
1712 
1713     if (!sdev || (megasas_is_jbod(s) && is_logical)) {
1714         trace_megasas_scsi_target_not_present(
1715             mfi_frame_desc(frame_cmd), is_logical, target_id, lun_id);
1716         return MFI_STAT_DEVICE_NOT_FOUND;
1717     }
1718 
1719     if (cdb_len > 16) {
1720         trace_megasas_scsi_invalid_cdb_len(
1721                 mfi_frame_desc(frame_cmd), is_logical,
1722                 target_id, lun_id, cdb_len);
1723         megasas_write_sense(cmd, SENSE_CODE(INVALID_OPCODE));
1724         cmd->frame->header.scsi_status = CHECK_CONDITION;
1725         s->event_count++;
1726         return MFI_STAT_SCSI_DONE_WITH_ERROR;
1727     }
1728 
1729     if (megasas_map_sgl(s, cmd, &cmd->frame->pass.sgl)) {
1730         megasas_write_sense(cmd, SENSE_CODE(TARGET_FAILURE));
1731         cmd->frame->header.scsi_status = CHECK_CONDITION;
1732         s->event_count++;
1733         return MFI_STAT_SCSI_DONE_WITH_ERROR;
1734     }
1735 
1736     cmd->req = scsi_req_new(sdev, cmd->index, lun_id, cdb, cmd);
1737     if (!cmd->req) {
1738         trace_megasas_scsi_req_alloc_failed(
1739                 mfi_frame_desc(frame_cmd), target_id, lun_id);
1740         megasas_write_sense(cmd, SENSE_CODE(NO_SENSE));
1741         cmd->frame->header.scsi_status = BUSY;
1742         s->event_count++;
1743         return MFI_STAT_SCSI_DONE_WITH_ERROR;
1744     }
1745 
1746     is_write = (cmd->req->cmd.mode == SCSI_XFER_TO_DEV);
1747     if (cmd->iov_size) {
1748         if (is_write) {
1749             trace_megasas_scsi_write_start(cmd->index, cmd->iov_size);
1750         } else {
1751             trace_megasas_scsi_read_start(cmd->index, cmd->iov_size);
1752         }
1753     } else {
1754         trace_megasas_scsi_nodata(cmd->index);
1755     }
1756     megasas_enqueue_req(cmd, is_write);
1757     return MFI_STAT_INVALID_STATUS;
1758 }
1759 
1760 static int megasas_handle_io(MegasasState *s, MegasasCmd *cmd, int frame_cmd)
1761 {
1762     uint32_t lba_count, lba_start_hi, lba_start_lo;
1763     uint64_t lba_start;
1764     bool is_write = (frame_cmd == MFI_CMD_LD_WRITE);
1765     uint8_t cdb[16];
1766     int len;
1767     struct SCSIDevice *sdev = NULL;
1768     int target_id, lun_id, cdb_len;
1769 
1770     lba_count = le32_to_cpu(cmd->frame->io.header.data_len);
1771     lba_start_lo = le32_to_cpu(cmd->frame->io.lba_lo);
1772     lba_start_hi = le32_to_cpu(cmd->frame->io.lba_hi);
1773     lba_start = ((uint64_t)lba_start_hi << 32) | lba_start_lo;
1774 
1775     target_id = cmd->frame->header.target_id;
1776     lun_id = cmd->frame->header.lun_id;
1777     cdb_len = cmd->frame->header.cdb_len;
1778 
1779     if (target_id < MFI_MAX_LD && lun_id == 0) {
1780         sdev = scsi_device_find(&s->bus, 0, target_id, lun_id);
1781     }
1782 
1783     trace_megasas_handle_io(cmd->index,
1784                             mfi_frame_desc(frame_cmd), target_id, lun_id,
1785                             (unsigned long)lba_start, (unsigned long)lba_count);
1786     if (!sdev) {
1787         trace_megasas_io_target_not_present(cmd->index,
1788             mfi_frame_desc(frame_cmd), target_id, lun_id);
1789         return MFI_STAT_DEVICE_NOT_FOUND;
1790     }
1791 
1792     if (cdb_len > 16) {
1793         trace_megasas_scsi_invalid_cdb_len(
1794             mfi_frame_desc(frame_cmd), 1, target_id, lun_id, cdb_len);
1795         megasas_write_sense(cmd, SENSE_CODE(INVALID_OPCODE));
1796         cmd->frame->header.scsi_status = CHECK_CONDITION;
1797         s->event_count++;
1798         return MFI_STAT_SCSI_DONE_WITH_ERROR;
1799     }
1800 
1801     cmd->iov_size = lba_count * sdev->blocksize;
1802     if (megasas_map_sgl(s, cmd, &cmd->frame->io.sgl)) {
1803         megasas_write_sense(cmd, SENSE_CODE(TARGET_FAILURE));
1804         cmd->frame->header.scsi_status = CHECK_CONDITION;
1805         s->event_count++;
1806         return MFI_STAT_SCSI_DONE_WITH_ERROR;
1807     }
1808 
1809     megasas_encode_lba(cdb, lba_start, lba_count, is_write);
1810     cmd->req = scsi_req_new(sdev, cmd->index,
1811                             lun_id, cdb, cmd);
1812     if (!cmd->req) {
1813         trace_megasas_scsi_req_alloc_failed(
1814             mfi_frame_desc(frame_cmd), target_id, lun_id);
1815         megasas_write_sense(cmd, SENSE_CODE(NO_SENSE));
1816         cmd->frame->header.scsi_status = BUSY;
1817         s->event_count++;
1818         return MFI_STAT_SCSI_DONE_WITH_ERROR;
1819     }
1820     len = megasas_enqueue_req(cmd, is_write);
1821     if (len > 0) {
1822         if (is_write) {
1823             trace_megasas_io_write_start(cmd->index, lba_start, lba_count, len);
1824         } else {
1825             trace_megasas_io_read_start(cmd->index, lba_start, lba_count, len);
1826         }
1827     }
1828     return MFI_STAT_INVALID_STATUS;
1829 }
1830 
1831 static QEMUSGList *megasas_get_sg_list(SCSIRequest *req)
1832 {
1833     MegasasCmd *cmd = req->hba_private;
1834 
1835     if (cmd->dcmd_opcode != -1) {
1836         return NULL;
1837     } else {
1838         return &cmd->qsg;
1839     }
1840 }
1841 
1842 static void megasas_xfer_complete(SCSIRequest *req, uint32_t len)
1843 {
1844     MegasasCmd *cmd = req->hba_private;
1845     uint8_t *buf;
1846 
1847     trace_megasas_io_complete(cmd->index, len);
1848 
1849     if (cmd->dcmd_opcode != -1) {
1850         scsi_req_continue(req);
1851         return;
1852     }
1853 
1854     buf = scsi_req_get_buf(req);
1855     if (cmd->dcmd_opcode == MFI_DCMD_PD_GET_INFO && cmd->iov_buf) {
1856         struct mfi_pd_info *info = cmd->iov_buf;
1857 
1858         if (info->inquiry_data[0] == 0x7f) {
1859             memset(info->inquiry_data, 0, sizeof(info->inquiry_data));
1860             memcpy(info->inquiry_data, buf, len);
1861         } else if (info->vpd_page83[0] == 0x7f) {
1862             memset(info->vpd_page83, 0, sizeof(info->vpd_page83));
1863             memcpy(info->vpd_page83, buf, len);
1864         }
1865         scsi_req_continue(req);
1866     } else if (cmd->dcmd_opcode == MFI_DCMD_LD_GET_INFO) {
1867         struct mfi_ld_info *info = cmd->iov_buf;
1868 
1869         if (cmd->iov_buf) {
1870             memcpy(info->vpd_page83, buf, sizeof(info->vpd_page83));
1871             scsi_req_continue(req);
1872         }
1873     }
1874 }
1875 
1876 static void megasas_command_complete(SCSIRequest *req, size_t residual)
1877 {
1878     MegasasCmd *cmd = req->hba_private;
1879     uint8_t cmd_status = MFI_STAT_OK;
1880 
1881     trace_megasas_command_complete(cmd->index, req->status, residual);
1882 
1883     if (req->io_canceled) {
1884         return;
1885     }
1886 
1887     if (cmd->dcmd_opcode != -1) {
1888         /*
1889          * Internal command complete
1890          */
1891         cmd_status = megasas_finish_internal_dcmd(cmd, req, residual);
1892         if (cmd_status == MFI_STAT_INVALID_STATUS) {
1893             return;
1894         }
1895     } else {
1896         trace_megasas_scsi_complete(cmd->index, req->status,
1897                                     cmd->iov_size, req->cmd.xfer);
1898         if (req->status != GOOD) {
1899             cmd_status = MFI_STAT_SCSI_DONE_WITH_ERROR;
1900         }
1901         if (req->status == CHECK_CONDITION) {
1902             megasas_copy_sense(cmd);
1903         }
1904 
1905         cmd->frame->header.scsi_status = req->status;
1906     }
1907     cmd->frame->header.cmd_status = cmd_status;
1908     megasas_complete_command(cmd);
1909 }
1910 
1911 static void megasas_command_cancelled(SCSIRequest *req)
1912 {
1913     MegasasCmd *cmd = req->hba_private;
1914 
1915     if (!cmd) {
1916         return;
1917     }
1918     cmd->frame->header.cmd_status = MFI_STAT_SCSI_IO_FAILED;
1919     megasas_complete_command(cmd);
1920 }
1921 
1922 static int megasas_handle_abort(MegasasState *s, MegasasCmd *cmd)
1923 {
1924     uint64_t abort_ctx = le64_to_cpu(cmd->frame->abort.abort_context);
1925     hwaddr abort_addr, addr_hi, addr_lo;
1926     MegasasCmd *abort_cmd;
1927 
1928     addr_hi = le32_to_cpu(cmd->frame->abort.abort_mfi_addr_hi);
1929     addr_lo = le32_to_cpu(cmd->frame->abort.abort_mfi_addr_lo);
1930     abort_addr = ((uint64_t)addr_hi << 32) | addr_lo;
1931 
1932     abort_cmd = megasas_lookup_frame(s, abort_addr);
1933     if (!abort_cmd) {
1934         trace_megasas_abort_no_cmd(cmd->index, abort_ctx);
1935         s->event_count++;
1936         return MFI_STAT_OK;
1937     }
1938     if (!megasas_use_queue64(s)) {
1939         abort_ctx &= (uint64_t)0xFFFFFFFF;
1940     }
1941     if (abort_cmd->context != abort_ctx) {
1942         trace_megasas_abort_invalid_context(cmd->index, abort_cmd->context,
1943                                             abort_cmd->index);
1944         s->event_count++;
1945         return MFI_STAT_ABORT_NOT_POSSIBLE;
1946     }
1947     trace_megasas_abort_frame(cmd->index, abort_cmd->index);
1948     megasas_abort_command(abort_cmd);
1949     if (!s->event_cmd || abort_cmd != s->event_cmd) {
1950         s->event_cmd = NULL;
1951     }
1952     s->event_count++;
1953     return MFI_STAT_OK;
1954 }
1955 
1956 static void megasas_handle_frame(MegasasState *s, uint64_t frame_addr,
1957                                  uint32_t frame_count)
1958 {
1959     uint8_t frame_status = MFI_STAT_INVALID_CMD;
1960     uint64_t frame_context;
1961     int frame_cmd;
1962     MegasasCmd *cmd;
1963 
1964     /*
1965      * Always read 64bit context, top bits will be
1966      * masked out if required in megasas_enqueue_frame()
1967      */
1968     frame_context = megasas_frame_get_context(s, frame_addr);
1969 
1970     cmd = megasas_enqueue_frame(s, frame_addr, frame_context, frame_count);
1971     if (!cmd) {
1972         /* reply queue full */
1973         trace_megasas_frame_busy(frame_addr);
1974         megasas_frame_set_scsi_status(s, frame_addr, BUSY);
1975         megasas_frame_set_cmd_status(s, frame_addr, MFI_STAT_SCSI_DONE_WITH_ERROR);
1976         megasas_complete_frame(s, frame_context);
1977         s->event_count++;
1978         return;
1979     }
1980     frame_cmd = cmd->frame->header.frame_cmd;
1981     switch (frame_cmd) {
1982     case MFI_CMD_INIT:
1983         frame_status = megasas_init_firmware(s, cmd);
1984         break;
1985     case MFI_CMD_DCMD:
1986         frame_status = megasas_handle_dcmd(s, cmd);
1987         break;
1988     case MFI_CMD_ABORT:
1989         frame_status = megasas_handle_abort(s, cmd);
1990         break;
1991     case MFI_CMD_PD_SCSI_IO:
1992     case MFI_CMD_LD_SCSI_IO:
1993         frame_status = megasas_handle_scsi(s, cmd, frame_cmd);
1994         break;
1995     case MFI_CMD_LD_READ:
1996     case MFI_CMD_LD_WRITE:
1997         frame_status = megasas_handle_io(s, cmd, frame_cmd);
1998         break;
1999     default:
2000         trace_megasas_unhandled_frame_cmd(cmd->index, frame_cmd);
2001         s->event_count++;
2002         break;
2003     }
2004     if (frame_status != MFI_STAT_INVALID_STATUS) {
2005         if (cmd->frame) {
2006             cmd->frame->header.cmd_status = frame_status;
2007         } else {
2008             megasas_frame_set_cmd_status(s, frame_addr, frame_status);
2009         }
2010         megasas_unmap_frame(s, cmd);
2011         megasas_complete_frame(s, cmd->context);
2012     }
2013 }
2014 
2015 static uint64_t megasas_mmio_read(void *opaque, hwaddr addr,
2016                                   unsigned size)
2017 {
2018     MegasasState *s = opaque;
2019     PCIDevice *pci_dev = PCI_DEVICE(s);
2020     MegasasBaseClass *base_class = MEGASAS_GET_CLASS(s);
2021     uint32_t retval = 0;
2022 
2023     switch (addr) {
2024     case MFI_IDB:
2025         retval = 0;
2026         trace_megasas_mmio_readl("MFI_IDB", retval);
2027         break;
2028     case MFI_OMSG0:
2029     case MFI_OSP0:
2030         retval = (msix_present(pci_dev) ? MFI_FWSTATE_MSIX_SUPPORTED : 0) |
2031             (s->fw_state & MFI_FWSTATE_MASK) |
2032             ((s->fw_sge & 0xff) << 16) |
2033             (s->fw_cmds & 0xFFFF);
2034         trace_megasas_mmio_readl(addr == MFI_OMSG0 ? "MFI_OMSG0" : "MFI_OSP0",
2035                                  retval);
2036         break;
2037     case MFI_OSTS:
2038         if (megasas_intr_enabled(s) && s->doorbell) {
2039             retval = base_class->osts;
2040         }
2041         trace_megasas_mmio_readl("MFI_OSTS", retval);
2042         break;
2043     case MFI_OMSK:
2044         retval = s->intr_mask;
2045         trace_megasas_mmio_readl("MFI_OMSK", retval);
2046         break;
2047     case MFI_ODCR0:
2048         retval = s->doorbell ? 1 : 0;
2049         trace_megasas_mmio_readl("MFI_ODCR0", retval);
2050         break;
2051     case MFI_DIAG:
2052         retval = s->diag;
2053         trace_megasas_mmio_readl("MFI_DIAG", retval);
2054         break;
2055     case MFI_OSP1:
2056         retval = 15;
2057         trace_megasas_mmio_readl("MFI_OSP1", retval);
2058         break;
2059     default:
2060         trace_megasas_mmio_invalid_readl(addr);
2061         break;
2062     }
2063     return retval;
2064 }
2065 
2066 static int adp_reset_seq[] = {0x00, 0x04, 0x0b, 0x02, 0x07, 0x0d};
2067 
2068 static void megasas_mmio_write(void *opaque, hwaddr addr,
2069                                uint64_t val, unsigned size)
2070 {
2071     MegasasState *s = opaque;
2072     PCIDevice *pci_dev = PCI_DEVICE(s);
2073     uint64_t frame_addr;
2074     uint32_t frame_count;
2075     int i;
2076 
2077     switch (addr) {
2078     case MFI_IDB:
2079         trace_megasas_mmio_writel("MFI_IDB", val);
2080         if (val & MFI_FWINIT_ABORT) {
2081             /* Abort all pending cmds */
2082             for (i = 0; i < s->fw_cmds; i++) {
2083                 megasas_abort_command(&s->frames[i]);
2084             }
2085         }
2086         if (val & MFI_FWINIT_READY) {
2087             /* move to FW READY */
2088             megasas_soft_reset(s);
2089         }
2090         if (val & MFI_FWINIT_MFIMODE) {
2091             /* discard MFIs */
2092         }
2093         if (val & MFI_FWINIT_STOP_ADP) {
2094             /* Terminal error, stop processing */
2095             s->fw_state = MFI_FWSTATE_FAULT;
2096         }
2097         break;
2098     case MFI_OMSK:
2099         trace_megasas_mmio_writel("MFI_OMSK", val);
2100         s->intr_mask = val;
2101         if (!megasas_intr_enabled(s) &&
2102             !msi_enabled(pci_dev) &&
2103             !msix_enabled(pci_dev)) {
2104             trace_megasas_irq_lower();
2105             pci_irq_deassert(pci_dev);
2106         }
2107         if (megasas_intr_enabled(s)) {
2108             if (msix_enabled(pci_dev)) {
2109                 trace_megasas_msix_enabled(0);
2110             } else if (msi_enabled(pci_dev)) {
2111                 trace_megasas_msi_enabled(0);
2112             } else {
2113                 trace_megasas_intr_enabled();
2114             }
2115         } else {
2116             trace_megasas_intr_disabled();
2117             megasas_soft_reset(s);
2118         }
2119         break;
2120     case MFI_ODCR0:
2121         trace_megasas_mmio_writel("MFI_ODCR0", val);
2122         s->doorbell = 0;
2123         if (megasas_intr_enabled(s)) {
2124             if (!msix_enabled(pci_dev) && !msi_enabled(pci_dev)) {
2125                 trace_megasas_irq_lower();
2126                 pci_irq_deassert(pci_dev);
2127             }
2128         }
2129         break;
2130     case MFI_IQPH:
2131         trace_megasas_mmio_writel("MFI_IQPH", val);
2132         /* Received high 32 bits of a 64 bit MFI frame address */
2133         s->frame_hi = val;
2134         break;
2135     case MFI_IQPL:
2136         trace_megasas_mmio_writel("MFI_IQPL", val);
2137         /* Received low 32 bits of a 64 bit MFI frame address */
2138         /* Fallthrough */
2139     case MFI_IQP:
2140         if (addr == MFI_IQP) {
2141             trace_megasas_mmio_writel("MFI_IQP", val);
2142             /* Received 64 bit MFI frame address */
2143             s->frame_hi = 0;
2144         }
2145         frame_addr = (val & ~0x1F);
2146         /* Add possible 64 bit offset */
2147         frame_addr |= ((uint64_t)s->frame_hi << 32);
2148         s->frame_hi = 0;
2149         frame_count = (val >> 1) & 0xF;
2150         megasas_handle_frame(s, frame_addr, frame_count);
2151         break;
2152     case MFI_SEQ:
2153         trace_megasas_mmio_writel("MFI_SEQ", val);
2154         /* Magic sequence to start ADP reset */
2155         if (adp_reset_seq[s->adp_reset++] == val) {
2156             if (s->adp_reset == 6) {
2157                 s->adp_reset = 0;
2158                 s->diag = MFI_DIAG_WRITE_ENABLE;
2159             }
2160         } else {
2161             s->adp_reset = 0;
2162             s->diag = 0;
2163         }
2164         break;
2165     case MFI_DIAG:
2166         trace_megasas_mmio_writel("MFI_DIAG", val);
2167         /* ADP reset */
2168         if ((s->diag & MFI_DIAG_WRITE_ENABLE) &&
2169             (val & MFI_DIAG_RESET_ADP)) {
2170             s->diag |= MFI_DIAG_RESET_ADP;
2171             megasas_soft_reset(s);
2172             s->adp_reset = 0;
2173             s->diag = 0;
2174         }
2175         break;
2176     default:
2177         trace_megasas_mmio_invalid_writel(addr, val);
2178         break;
2179     }
2180 }
2181 
2182 static const MemoryRegionOps megasas_mmio_ops = {
2183     .read = megasas_mmio_read,
2184     .write = megasas_mmio_write,
2185     .endianness = DEVICE_LITTLE_ENDIAN,
2186     .impl = {
2187         .min_access_size = 8,
2188         .max_access_size = 8,
2189     }
2190 };
2191 
2192 static uint64_t megasas_port_read(void *opaque, hwaddr addr,
2193                                   unsigned size)
2194 {
2195     return megasas_mmio_read(opaque, addr & 0xff, size);
2196 }
2197 
2198 static void megasas_port_write(void *opaque, hwaddr addr,
2199                                uint64_t val, unsigned size)
2200 {
2201     megasas_mmio_write(opaque, addr & 0xff, val, size);
2202 }
2203 
2204 static const MemoryRegionOps megasas_port_ops = {
2205     .read = megasas_port_read,
2206     .write = megasas_port_write,
2207     .endianness = DEVICE_LITTLE_ENDIAN,
2208     .impl = {
2209         .min_access_size = 4,
2210         .max_access_size = 4,
2211     }
2212 };
2213 
2214 static uint64_t megasas_queue_read(void *opaque, hwaddr addr,
2215                                    unsigned size)
2216 {
2217     return 0;
2218 }
2219 
2220 static void megasas_queue_write(void *opaque, hwaddr addr,
2221                                uint64_t val, unsigned size)
2222 {
2223     return;
2224 }
2225 
2226 static const MemoryRegionOps megasas_queue_ops = {
2227     .read = megasas_queue_read,
2228     .write = megasas_queue_write,
2229     .endianness = DEVICE_LITTLE_ENDIAN,
2230     .impl = {
2231         .min_access_size = 8,
2232         .max_access_size = 8,
2233     }
2234 };
2235 
2236 static void megasas_soft_reset(MegasasState *s)
2237 {
2238     int i;
2239     MegasasCmd *cmd;
2240 
2241     trace_megasas_reset(s->fw_state);
2242     for (i = 0; i < s->fw_cmds; i++) {
2243         cmd = &s->frames[i];
2244         megasas_abort_command(cmd);
2245     }
2246     if (s->fw_state == MFI_FWSTATE_READY) {
2247         BusChild *kid;
2248 
2249         /*
2250          * The EFI firmware doesn't handle UA,
2251          * so we need to clear the Power On/Reset UA
2252          * after the initial reset.
2253          */
2254         QTAILQ_FOREACH(kid, &s->bus.qbus.children, sibling) {
2255             SCSIDevice *sdev = SCSI_DEVICE(kid->child);
2256 
2257             sdev->unit_attention = SENSE_CODE(NO_SENSE);
2258             scsi_device_unit_attention_reported(sdev);
2259         }
2260     }
2261     megasas_reset_frames(s);
2262     s->reply_queue_len = s->fw_cmds;
2263     s->reply_queue_pa = 0;
2264     s->consumer_pa = 0;
2265     s->producer_pa = 0;
2266     s->fw_state = MFI_FWSTATE_READY;
2267     s->doorbell = 0;
2268     s->intr_mask = MEGASAS_INTR_DISABLED_MASK;
2269     s->frame_hi = 0;
2270     s->flags &= ~MEGASAS_MASK_USE_QUEUE64;
2271     s->event_count++;
2272     s->boot_event = s->event_count;
2273 }
2274 
2275 static void megasas_scsi_reset(DeviceState *dev)
2276 {
2277     MegasasState *s = MEGASAS(dev);
2278 
2279     megasas_soft_reset(s);
2280 }
2281 
2282 static const VMStateDescription vmstate_megasas_gen1 = {
2283     .name = "megasas",
2284     .version_id = 0,
2285     .minimum_version_id = 0,
2286     .fields = (VMStateField[]) {
2287         VMSTATE_PCI_DEVICE(parent_obj, MegasasState),
2288         VMSTATE_MSIX(parent_obj, MegasasState),
2289 
2290         VMSTATE_UINT32(fw_state, MegasasState),
2291         VMSTATE_UINT32(intr_mask, MegasasState),
2292         VMSTATE_UINT32(doorbell, MegasasState),
2293         VMSTATE_UINT64(reply_queue_pa, MegasasState),
2294         VMSTATE_UINT64(consumer_pa, MegasasState),
2295         VMSTATE_UINT64(producer_pa, MegasasState),
2296         VMSTATE_END_OF_LIST()
2297     }
2298 };
2299 
2300 static const VMStateDescription vmstate_megasas_gen2 = {
2301     .name = "megasas-gen2",
2302     .version_id = 0,
2303     .minimum_version_id = 0,
2304     .minimum_version_id_old = 0,
2305     .fields      = (VMStateField[]) {
2306         VMSTATE_PCI_DEVICE(parent_obj, MegasasState),
2307         VMSTATE_MSIX(parent_obj, MegasasState),
2308 
2309         VMSTATE_UINT32(fw_state, MegasasState),
2310         VMSTATE_UINT32(intr_mask, MegasasState),
2311         VMSTATE_UINT32(doorbell, MegasasState),
2312         VMSTATE_UINT64(reply_queue_pa, MegasasState),
2313         VMSTATE_UINT64(consumer_pa, MegasasState),
2314         VMSTATE_UINT64(producer_pa, MegasasState),
2315         VMSTATE_END_OF_LIST()
2316     }
2317 };
2318 
2319 static void megasas_scsi_uninit(PCIDevice *d)
2320 {
2321     MegasasState *s = MEGASAS(d);
2322 
2323     if (megasas_use_msix(s)) {
2324         msix_uninit(d, &s->mmio_io, &s->mmio_io);
2325     }
2326     msi_uninit(d);
2327 }
2328 
2329 static const struct SCSIBusInfo megasas_scsi_info = {
2330     .tcq = true,
2331     .max_target = MFI_MAX_LD,
2332     .max_lun = 255,
2333 
2334     .transfer_data = megasas_xfer_complete,
2335     .get_sg_list = megasas_get_sg_list,
2336     .complete = megasas_command_complete,
2337     .cancel = megasas_command_cancelled,
2338 };
2339 
2340 static void megasas_scsi_realize(PCIDevice *dev, Error **errp)
2341 {
2342     MegasasState *s = MEGASAS(dev);
2343     MegasasBaseClass *b = MEGASAS_GET_CLASS(s);
2344     uint8_t *pci_conf;
2345     int i, bar_type;
2346     Error *err = NULL;
2347     int ret;
2348 
2349     pci_conf = dev->config;
2350 
2351     /* PCI latency timer = 0 */
2352     pci_conf[PCI_LATENCY_TIMER] = 0;
2353     /* Interrupt pin 1 */
2354     pci_conf[PCI_INTERRUPT_PIN] = 0x01;
2355 
2356     if (s->msi != ON_OFF_AUTO_OFF) {
2357         ret = msi_init(dev, 0x50, 1, true, false, &err);
2358         /* Any error other than -ENOTSUP(board's MSI support is broken)
2359          * is a programming error */
2360         assert(!ret || ret == -ENOTSUP);
2361         if (ret && s->msi == ON_OFF_AUTO_ON) {
2362             /* Can't satisfy user's explicit msi=on request, fail */
2363             error_append_hint(&err, "You have to use msi=auto (default) or "
2364                     "msi=off with this machine type.\n");
2365             error_propagate(errp, err);
2366             return;
2367         } else if (ret) {
2368             /* With msi=auto, we fall back to MSI off silently */
2369             s->msi = ON_OFF_AUTO_OFF;
2370             error_free(err);
2371         }
2372     }
2373 
2374     memory_region_init_io(&s->mmio_io, OBJECT(s), &megasas_mmio_ops, s,
2375                           "megasas-mmio", 0x4000);
2376     memory_region_init_io(&s->port_io, OBJECT(s), &megasas_port_ops, s,
2377                           "megasas-io", 256);
2378     memory_region_init_io(&s->queue_io, OBJECT(s), &megasas_queue_ops, s,
2379                           "megasas-queue", 0x40000);
2380 
2381     if (megasas_use_msix(s) &&
2382         msix_init(dev, 15, &s->mmio_io, b->mmio_bar, 0x2000,
2383                   &s->mmio_io, b->mmio_bar, 0x3800, 0x68, NULL)) {
2384         /* TODO: check msix_init's error, and should fail on msix=on */
2385         s->msix = ON_OFF_AUTO_OFF;
2386     }
2387 
2388     if (pci_is_express(dev)) {
2389         pcie_endpoint_cap_init(dev, 0xa0);
2390     }
2391 
2392     bar_type = PCI_BASE_ADDRESS_SPACE_MEMORY | PCI_BASE_ADDRESS_MEM_TYPE_64;
2393     pci_register_bar(dev, b->ioport_bar,
2394                      PCI_BASE_ADDRESS_SPACE_IO, &s->port_io);
2395     pci_register_bar(dev, b->mmio_bar, bar_type, &s->mmio_io);
2396     pci_register_bar(dev, 3, bar_type, &s->queue_io);
2397 
2398     if (megasas_use_msix(s)) {
2399         msix_vector_use(dev, 0);
2400     }
2401 
2402     s->fw_state = MFI_FWSTATE_READY;
2403     if (!s->sas_addr) {
2404         s->sas_addr = ((NAA_LOCALLY_ASSIGNED_ID << 24) |
2405                        IEEE_COMPANY_LOCALLY_ASSIGNED) << 36;
2406         s->sas_addr |= pci_dev_bus_num(dev) << 16;
2407         s->sas_addr |= PCI_SLOT(dev->devfn) << 8;
2408         s->sas_addr |= PCI_FUNC(dev->devfn);
2409     }
2410     if (!s->hba_serial) {
2411         s->hba_serial = g_strdup(MEGASAS_HBA_SERIAL);
2412     }
2413     if (s->fw_sge >= MEGASAS_MAX_SGE - MFI_PASS_FRAME_SIZE) {
2414         s->fw_sge = MEGASAS_MAX_SGE - MFI_PASS_FRAME_SIZE;
2415     } else if (s->fw_sge >= 128 - MFI_PASS_FRAME_SIZE) {
2416         s->fw_sge = 128 - MFI_PASS_FRAME_SIZE;
2417     } else {
2418         s->fw_sge = 64 - MFI_PASS_FRAME_SIZE;
2419     }
2420     if (s->fw_cmds > MEGASAS_MAX_FRAMES) {
2421         s->fw_cmds = MEGASAS_MAX_FRAMES;
2422     }
2423     trace_megasas_init(s->fw_sge, s->fw_cmds,
2424                        megasas_is_jbod(s) ? "jbod" : "raid");
2425 
2426     if (megasas_is_jbod(s)) {
2427         s->fw_luns = MFI_MAX_SYS_PDS;
2428     } else {
2429         s->fw_luns = MFI_MAX_LD;
2430     }
2431     s->producer_pa = 0;
2432     s->consumer_pa = 0;
2433     for (i = 0; i < s->fw_cmds; i++) {
2434         s->frames[i].index = i;
2435         s->frames[i].context = -1;
2436         s->frames[i].pa = 0;
2437         s->frames[i].state = s;
2438     }
2439 
2440     scsi_bus_init(&s->bus, sizeof(s->bus), DEVICE(dev), &megasas_scsi_info);
2441 }
2442 
2443 static Property megasas_properties_gen1[] = {
2444     DEFINE_PROP_UINT32("max_sge", MegasasState, fw_sge,
2445                        MEGASAS_DEFAULT_SGE),
2446     DEFINE_PROP_UINT32("max_cmds", MegasasState, fw_cmds,
2447                        MEGASAS_DEFAULT_FRAMES),
2448     DEFINE_PROP_STRING("hba_serial", MegasasState, hba_serial),
2449     DEFINE_PROP_UINT64("sas_address", MegasasState, sas_addr, 0),
2450     DEFINE_PROP_ON_OFF_AUTO("msi", MegasasState, msi, ON_OFF_AUTO_AUTO),
2451     DEFINE_PROP_ON_OFF_AUTO("msix", MegasasState, msix, ON_OFF_AUTO_AUTO),
2452     DEFINE_PROP_BIT("use_jbod", MegasasState, flags,
2453                     MEGASAS_FLAG_USE_JBOD, false),
2454     DEFINE_PROP_END_OF_LIST(),
2455 };
2456 
2457 static Property megasas_properties_gen2[] = {
2458     DEFINE_PROP_UINT32("max_sge", MegasasState, fw_sge,
2459                        MEGASAS_DEFAULT_SGE),
2460     DEFINE_PROP_UINT32("max_cmds", MegasasState, fw_cmds,
2461                        MEGASAS_GEN2_DEFAULT_FRAMES),
2462     DEFINE_PROP_STRING("hba_serial", MegasasState, hba_serial),
2463     DEFINE_PROP_UINT64("sas_address", MegasasState, sas_addr, 0),
2464     DEFINE_PROP_ON_OFF_AUTO("msi", MegasasState, msi, ON_OFF_AUTO_AUTO),
2465     DEFINE_PROP_ON_OFF_AUTO("msix", MegasasState, msix, ON_OFF_AUTO_AUTO),
2466     DEFINE_PROP_BIT("use_jbod", MegasasState, flags,
2467                     MEGASAS_FLAG_USE_JBOD, false),
2468     DEFINE_PROP_END_OF_LIST(),
2469 };
2470 
2471 typedef struct MegasasInfo {
2472     const char *name;
2473     const char *desc;
2474     const char *product_name;
2475     const char *product_version;
2476     uint16_t device_id;
2477     uint16_t subsystem_id;
2478     int ioport_bar;
2479     int mmio_bar;
2480     int osts;
2481     const VMStateDescription *vmsd;
2482     Property *props;
2483     InterfaceInfo *interfaces;
2484 } MegasasInfo;
2485 
2486 static struct MegasasInfo megasas_devices[] = {
2487     {
2488         .name = TYPE_MEGASAS_GEN1,
2489         .desc = "LSI MegaRAID SAS 1078",
2490         .product_name = "LSI MegaRAID SAS 8708EM2",
2491         .product_version = MEGASAS_VERSION_GEN1,
2492         .device_id = PCI_DEVICE_ID_LSI_SAS1078,
2493         .subsystem_id = 0x1013,
2494         .ioport_bar = 2,
2495         .mmio_bar = 0,
2496         .osts = MFI_1078_RM | 1,
2497         .vmsd = &vmstate_megasas_gen1,
2498         .props = megasas_properties_gen1,
2499         .interfaces = (InterfaceInfo[]) {
2500             { INTERFACE_CONVENTIONAL_PCI_DEVICE },
2501             { },
2502         },
2503     },{
2504         .name = TYPE_MEGASAS_GEN2,
2505         .desc = "LSI MegaRAID SAS 2108",
2506         .product_name = "LSI MegaRAID SAS 9260-8i",
2507         .product_version = MEGASAS_VERSION_GEN2,
2508         .device_id = PCI_DEVICE_ID_LSI_SAS0079,
2509         .subsystem_id = 0x9261,
2510         .ioport_bar = 0,
2511         .mmio_bar = 1,
2512         .osts = MFI_GEN2_RM,
2513         .vmsd = &vmstate_megasas_gen2,
2514         .props = megasas_properties_gen2,
2515         .interfaces = (InterfaceInfo[]) {
2516             { INTERFACE_PCIE_DEVICE },
2517             { }
2518         },
2519     }
2520 };
2521 
2522 static void megasas_class_init(ObjectClass *oc, void *data)
2523 {
2524     DeviceClass *dc = DEVICE_CLASS(oc);
2525     PCIDeviceClass *pc = PCI_DEVICE_CLASS(oc);
2526     MegasasBaseClass *e = MEGASAS_CLASS(oc);
2527     const MegasasInfo *info = data;
2528 
2529     pc->realize = megasas_scsi_realize;
2530     pc->exit = megasas_scsi_uninit;
2531     pc->vendor_id = PCI_VENDOR_ID_LSI_LOGIC;
2532     pc->device_id = info->device_id;
2533     pc->subsystem_vendor_id = PCI_VENDOR_ID_LSI_LOGIC;
2534     pc->subsystem_id = info->subsystem_id;
2535     pc->class_id = PCI_CLASS_STORAGE_RAID;
2536     e->mmio_bar = info->mmio_bar;
2537     e->ioport_bar = info->ioport_bar;
2538     e->osts = info->osts;
2539     e->product_name = info->product_name;
2540     e->product_version = info->product_version;
2541     device_class_set_props(dc, info->props);
2542     dc->reset = megasas_scsi_reset;
2543     dc->vmsd = info->vmsd;
2544     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
2545     dc->desc = info->desc;
2546 }
2547 
2548 static const TypeInfo megasas_info = {
2549     .name  = TYPE_MEGASAS_BASE,
2550     .parent = TYPE_PCI_DEVICE,
2551     .instance_size = sizeof(MegasasState),
2552     .class_size = sizeof(MegasasBaseClass),
2553     .abstract = true,
2554 };
2555 
2556 static void megasas_register_types(void)
2557 {
2558     int i;
2559 
2560     type_register_static(&megasas_info);
2561     for (i = 0; i < ARRAY_SIZE(megasas_devices); i++) {
2562         const MegasasInfo *info = &megasas_devices[i];
2563         TypeInfo type_info = {};
2564 
2565         type_info.name = info->name;
2566         type_info.parent = TYPE_MEGASAS_BASE;
2567         type_info.class_data = (void *)info;
2568         type_info.class_init = megasas_class_init;
2569         type_info.interfaces = info->interfaces;
2570 
2571         type_register(&type_info);
2572     }
2573 }
2574 
2575 type_init(megasas_register_types)
2576