Changeset 92716 in vbox for trunk/src/VBox/VMM/VMMR3/IOMR3IoPort.cpp

Timestamp:

Dec 2, 2021 9:17:42 PM (3 years ago)

Author:

vboxsync

svn:sync-xref-src-repo-rev:

148617

Message:

VMM/IOM: Made I/O port and MMIO registrations work in driverless mode. bugref:10138

File:

• trunk/src/VBox/VMM/VMMR3/IOMR3IoPort.cpp (modified) (4 diffs)

trunk/src/VBox/VMM/VMMR3/IOMR3IoPort.cpp

@@ -33 +33 @@
 #include <VBox/param.h>
 #include <iprt/assert.h>
+#include <iprt/mem.h>
 #include <iprt/string.h>
 #include <VBox/log.h>
@@ -198 +199 @@
 
 
+#ifdef VBOX_WITH_STATISTICS
+/**
+ * Grows the statistics table.
+ *
+ * @returns VBox status code.
+ * @param   pVM             The cross context VM structure.
+ * @param   cNewEntries     The minimum number of new entrie.
+ * @see     IOMR0IoPortGrowStatisticsTable
+ */
+static int iomR3IoPortGrowStatisticsTable(PVM pVM, uint32_t cNewEntries)
+{
+    AssertReturn(cNewEntries <= _64K, VERR_IOM_TOO_MANY_IOPORT_REGISTRATIONS);
+
+    int rc;
+    if (!SUPR3IsDriverless())
+    {
+        rc = VMMR3CallR0Emt(pVM, pVM->apCpusR3[0], VMMR0_DO_IOM_GROW_IO_PORT_STATS, cNewEntries, NULL);
+        AssertLogRelRCReturn(rc, rc);
+        AssertReturn(cNewEntries <= pVM->iom.s.cIoPortStatsAllocation, VERR_IOM_IOPORT_IPE_2);
+    }
+    else
+    {
+        /*
+         * Validate input and state.
+         */
+        uint32_t const cOldEntries = pVM->iom.s.cIoPortStatsAllocation;
+        AssertReturn(cNewEntries > cOldEntries, VERR_IOM_IOPORT_IPE_1);
+        AssertReturn(pVM->iom.s.cIoPortStats <= cOldEntries, VERR_IOM_IOPORT_IPE_2);
+
+        /*
+         * Calc size and allocate a new table.
+         */
+        uint32_t const cbNew = RT_ALIGN_32(cNewEntries * sizeof(IOMIOPORTSTATSENTRY), PAGE_SIZE);
+        cNewEntries = cbNew / sizeof(IOMIOPORTSTATSENTRY);
+
+        PIOMIOPORTSTATSENTRY const paIoPortStats = (PIOMIOPORTSTATSENTRY)RTMemPageAllocZ(cbNew);
+        if (paIoPortStats)
+        {
+            /*
+             * Anything to copy over, update and free the old one.
+             */
+            PIOMIOPORTSTATSENTRY const pOldIoPortStats = pVM->iom.s.paIoPortStats;
+            if (pOldIoPortStats)
+                memcpy(paIoPortStats, pOldIoPortStats, cOldEntries * sizeof(IOMIOPORTSTATSENTRY));
+
+            pVM->iom.s.paIoPortStats             = paIoPortStats;
+            pVM->iom.s.cIoPortStatsAllocation    = cNewEntries;
+
+            RTMemPageFree(pOldIoPortStats, RT_ALIGN_32(cOldEntries * sizeof(IOMIOPORTSTATSENTRY), PAGE_SIZE));
+
+            rc = VINF_SUCCESS;
+        }
+        else
+            rc = VERR_NO_PAGE_MEMORY;
+    }
+
+    return rc;
+}
+#endif
+
+
+/**
+ * Grows the I/O port registration statistics table.
+ *
+ * @returns VBox status code.
+ * @param   pVM             The cross context VM structure.
+ * @param   cNewEntries     The minimum number of new entrie.
+ * @see     IOMR0IoPortGrowRegistrationTables
+ */
+static int iomR3IoPortGrowTable(PVM pVM, uint32_t cNewEntries)
+{
+    AssertReturn(cNewEntries <= _4K, VERR_IOM_TOO_MANY_IOPORT_REGISTRATIONS);
+
+    int rc;
+    if (!SUPR3IsDriverless())
+    {
+        rc = VMMR3CallR0Emt(pVM, pVM->apCpusR3[0], VMMR0_DO_IOM_GROW_IO_PORTS, cNewEntries, NULL);
+        AssertLogRelRCReturn(rc, rc);
+        AssertReturn(cNewEntries <= pVM->iom.s.cIoPortAlloc, VERR_IOM_IOPORT_IPE_2);
+    }
+    else
+    {
+        /*
+         * Validate input and state.
+         */
+        uint32_t const cOldEntries = pVM->iom.s.cIoPortAlloc;
+        AssertReturn(cNewEntries >= cOldEntries, VERR_IOM_IOPORT_IPE_1);
+
+        /*
+         * Allocate the new tables.  We use a single allocation for the three tables (ring-0,
+         * ring-3, lookup) and does a partial mapping of the result to ring-3.
+         */
+        uint32_t const cbRing3  = RT_ALIGN_32(cNewEntries * sizeof(IOMIOPORTENTRYR3),     PAGE_SIZE);
+        uint32_t const cbShared = RT_ALIGN_32(cNewEntries * sizeof(IOMIOPORTLOOKUPENTRY), PAGE_SIZE);
+        uint32_t const cbNew    = cbRing3 + cbShared;
+
+        /* Use the rounded up space as best we can. */
+        cNewEntries = RT_MIN(cbRing3 / sizeof(IOMIOPORTENTRYR3), cbShared / sizeof(IOMIOPORTLOOKUPENTRY));
+
+        PIOMIOPORTENTRYR3 const paRing3 = (PIOMIOPORTENTRYR3)RTMemPageAllocZ(cbNew);
+        if (paRing3)
+        {
+            PIOMIOPORTLOOKUPENTRY const paLookup = (PIOMIOPORTLOOKUPENTRY)((uintptr_t)paRing3 + cbRing3);
+
+            /*
+             * Copy over the old info and initialize the idxSelf and idxStats members.
+             */
+            if (pVM->iom.s.paIoPortRegs != NULL)
+            {
+                memcpy(paRing3,  pVM->iom.s.paIoPortRegs,    sizeof(paRing3[0])  * cOldEntries);
+                memcpy(paLookup, pVM->iom.s.paIoPortLookup,  sizeof(paLookup[0]) * cOldEntries);
+            }
+
+            size_t i = cbRing3 / sizeof(*paRing3);
+            while (i-- > cOldEntries)
+            {
+                paRing3[i].idxSelf  = (uint16_t)i;
+                paRing3[i].idxStats = UINT16_MAX;
+            }
+
+            /*
+             * Update the variables and free the old memory.
+             */
+            void * const pvFree =  pVM->iom.s.paIoPortRegs;
+
+            pVM->iom.s.paIoPortRegs     = paRing3;
+            pVM->iom.s.paIoPortLookup   = paLookup;
+            pVM->iom.s.cIoPortAlloc     = cNewEntries;
+
+            RTMemPageFree(pvFree,
+                            RT_ALIGN_32(cOldEntries * sizeof(IOMIOPORTENTRYR3),     PAGE_SIZE)
+                          + RT_ALIGN_32(cOldEntries * sizeof(IOMIOPORTLOOKUPENTRY), PAGE_SIZE));
+
+            rc = VINF_SUCCESS;
+        }
+        else
+            rc = VERR_NO_PAGE_MEMORY;
+    }
+    return rc;
+}
+
 
 /**
@@ -254 +396 @@
     if (cNewIoPortStats > pVM->iom.s.cIoPortStatsAllocation)
     {
-        int rc = VMMR3CallR0Emt(pVM, pVM->apCpusR3[0], VMMR0_DO_IOM_GROW_IO_PORT_STATS, cNewIoPortStats, NULL);
-        AssertLogRelRCReturn(rc, rc);
+        int rc = iomR3IoPortGrowStatisticsTable(pVM, cNewIoPortStats);
+        AssertRCReturn(rc, rc);
         AssertReturn(idxStats == pVM->iom.s.cIoPortStats, VERR_IOM_IOPORT_IPE_1);
-        AssertReturn(cNewIoPortStats <= pVM->iom.s.cIoPortStatsAllocation, VERR_IOM_IOPORT_IPE_2);
     }
 #endif
@@ -264 +405 @@
     if (idx >= pVM->iom.s.cIoPortAlloc)
     {
-        int rc = VMMR3CallR0Emt(pVM, pVM->apCpusR3[0], VMMR0_DO_IOM_GROW_IO_PORTS, pVM->iom.s.cIoPortAlloc + 1, NULL);
-        AssertLogRelRCReturn(rc, rc);
+        int rc = iomR3IoPortGrowTable(pVM, pVM->iom.s.cIoPortAlloc + 1);
+        AssertRCReturn(rc, rc);
         AssertReturn(idx == pVM->iom.s.cIoPortRegs, VERR_IOM_IOPORT_IPE_1);
         AssertReturn(idx < pVM->iom.s.cIoPortAlloc, VERR_IOM_IOPORT_IPE_2);