Changeset 20464 in vbox for trunk/src/VBox/Devices/PC/ACPI/VBoxAcpi.cpp

Timestamp:

Jun 10, 2009 2:27:05 PM (16 years ago)

Author:

vboxsync

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

48435

Message:

ACPI: dynamic ACPI tables patching for CPU count support

File:

• trunk/src/VBox/Devices/PC/ACPI/VBoxAcpi.cpp (modified) (3 diffs)

trunk/src/VBox/Devices/PC/ACPI/VBoxAcpi.cpp

@@ -40 +40 @@
 
 #ifdef VBOX_WITH_DYNAMIC_DSDT
+
 static int prepareDynamicDsdt(PPDMDEVINS pDevIns,  
                               void*      *ppPtr, 
                               size_t     *puDsdtLen)
 {
-    //LogRel(("file is %s\n", g_abVboxDslSource));
+    ACPI_STATUS Status = AdInitialize();
+    if (ACPI_FAILURE (Status))
+    {
+        AssertFailed();
+        return VERR_INVALID_PARAMETER;
+    }
+
+    Status = CmDoCompile();
+    AcpiTerminate();
+
+    if (Gbl_ExceptionCount[ASL_ERROR] > 0)
+    {
+        AssertFailed();
+        return VERR_INVALID_PARAMETER;
+    }
+
+    LogRel(("OK file is %s\n", g_abVboxDslSource));
     *ppPtr = NULL;
     *puDsdtLen = 0;
@@ -55 +72 @@
     return 0;
 }
+
+#else
+static int patchAml(PPDMDEVINS pDevIns, uint8_t* pAml, size_t uAmlLen)
+{
+    uint16_t cNumCpus;
+    int rc;
+    
+    rc = CFGMR3QueryU16Def(pDevIns->pCfgHandle, "NumCPUs", &cNumCpus, 1);
+   
+    if (RT_FAILURE(rc))
+        return rc;
+    
+    /** 
+     * Now search AML for:
+     *  AML_PROCESSOR_OP            (UINT16) 0x5b83
+     * and replace whole block with
+     *  AML_NOOP_OP                 (UINT16) 0xa3 
+     * for VCPU not configured
+     */
+    uint16_t cAcpiCpus = 0;
+    for (uint32_t i = 0; i < uAmlLen - 5; i++)
+    {
+        /*
+         * AML_PROCESSOR_OP 
+         *
+         * DefProcessor := ProcessorOp PkgLength NameString ProcID 
+                             PblkAddr PblkLen ObjectList
+         * ProcessorOp  := ExtOpPrefix 0x83
+         * ProcID       := ByteData
+         * PblkAddr     := DwordData
+         * PblkLen      := ByteData
+         */
+        if ((pAml[i] == 0x5b) && (pAml[i+1] == 0x83))
+        {
+            if ((pAml[i+3] != 'C') || (pAml[i+4] != 'P'))
+                /* false alarm, not named starting CP */
+                continue;
+            
+            /* Maybe use ProcID instead? */
+            cAcpiCpus++;
+            if (cAcpiCpus <= cNumCpus)
+                continue;
+
+            /* Will fill unwanted CPU block with NOOPs */
+            /* 
+             * See 18.2.4 Package Length Encoding in ACPI spec 
+             * for full format 
+             */
+            uint32_t cBytes = pAml[i + 2];
+            AssertReleaseMsg((cBytes >> 6) == 0, 
+                             ("So far, we only understand simple package length"));
+                
+            /* including AML_PROCESSOR_OP itself */
+            for (uint32_t j = 0; j < cBytes + 2; j++)
+                pAml[i+j] = 0xa3;
+
+            /* Can increase i by cBytes + 1, but not really worth it */
+        }
+    }
+
+        
+    /* now recompute checksum, whole file byte sum must be 0 */
+    pAml[9] = 0;
+    signed char         Sum;
+    for (uint32_t i = 0; i < uAmlLen; i++)
+         Sum = (signed char) (Sum + pAml[i]);
+    pAml[9] = (uint8_t) (0 - Sum);
+
+    return 0;
+}
 #endif
 
@@ -63 +150 @@
     return prepareDynamicDsdt(pDevIns, ppPtr, puDsdtLen);
 #else
-    *ppPtr = AmlCode;
+    int rc;
+    
+    rc = patchAml(pDevIns, &AmlCode[0], sizeof(AmlCode));
+    if (RT_FAILURE(rc))
+        return rc;
+
+    *ppPtr = &AmlCode[0];
     *puDsdtLen = sizeof(AmlCode);
+
     return 0;
 #endif