Changeset 406 for branches/branch-1-0/src/helpers/acpih.c

Timestamp:

Feb 23, 2012, 12:13:33 AM (13 years ago)

Author:

shl

Message:

Add additioned ACPI support for battery and temperature monitoring
Code from David Azarewicz

File:

• branches/branch-1-0/src/helpers/acpih.c (modified) (6 diffs)

branches/branch-1-0/src/helpers/acpih.c

@@ -40 +40 @@
 #include "setup.h"                      // code generation and debugging options
 
+#include "helpers\apmh.h"               // @@added V1.0.9 (2012-02-20) [slevine]
 #include "helpers\acpih.h"
 #include "helpers\standards.h"
@@ -51 +52 @@
 HMODULE       G_hmodACPI = NULLHANDLE;
 ULONG         G_ulCount = 0;
+// @@added V1.0.9 (2012-02-20) [slevine]: additional ACPI support, code from David Azarewicz
+ACPI_HANDLE   G_ahAC = 0;
+#define MAX_BATTERY_COUNT 4
+ACPI_HANDLE   G_ahBat[MAX_BATTERY_COUNT];
+ULONG         G_uiBatteryCount = 0;
+ULONG         G_uiAlreadyWalked = 0;
 
 ACPISTARTAPI  *pAcpiStartApi = NULL;
@@ -56 +63 @@
 ACPIGOTOSLEEP *pAcpiGoToSleep = NULL;
 
+ACPITKGETOBJECTINFOALLOC *pAcpiTkGetObjectInfoAlloc = NULL;
+ACPITKGETHANDLE *pAcpiTkGetHandle = NULL;
+ACPITKOSFREE *pAcpiTkOsFree = NULL;
+ACPITKWALKNAMESPACE *pAcpiTkWalkNamespace = NULL;
+ACPITKEVALUATEOBJECT *pAcpiTkEvaluateObject = NULL;
+
 /*
  *@@category: Helpers\Control program helpers\ACPI
@@ -71 +84 @@
 
     if (!G_hmodACPI)
+    {
         if (!(arc = DosLoadModule(NULL,
                                   0,
@@ -100 +114 @@
                 return(arc);
             }
-        }
+
+            // @@added V1.0.9 (2012-02-20) [slevine]: additional ACPI support, code from David Azarewicz
+            DosQueryProcAddr(G_hmodACPI, ORD_ACPITKGETOBJECTINFOALLOC, NULL, (PFN *) &pAcpiTkGetObjectInfoAlloc);
+            DosQueryProcAddr(G_hmodACPI, ORD_ACPITKGETHANDLE, NULL, (PFN *) &pAcpiTkGetHandle);
+            DosQueryProcAddr(G_hmodACPI, ORD_ACPITKOSFREE, NULL, (PFN *) &pAcpiTkOsFree);
+            DosQueryProcAddr(G_hmodACPI, ORD_ACPITKWALKNAMESPACE, NULL, (PFN *) &pAcpiTkWalkNamespace);
+            DosQueryProcAddr(G_hmodACPI, ORD_ACPITKEVALUATEOBJECT, NULL, (PFN *) &pAcpiTkEvaluateObject);
+        }
+    }
 
     if (arc)
@@ -147 +169 @@
 }
 
+
+/**
+ *@@ AcpiCallbackWidget:
+ *      ACPI callback helper for battery and power status queries.
+ *      Code provided by David Azarewicz
+ *@@added V1.0.9 (2012-02-20) [slevine]: code from David Azarewicz
+ */
+
+#define AE_DEPTH AE_OK
+
+ACPI_STATUS AcpiCallbackWidget( ACPI_HANDLE ObjHandle, UINT32 NestingLevel, void *Context, void **ReturnValue )
+{
+    ACPI_STATUS Status;
+    ACPI_DEVICE_INFO *pDevInfo;
+
+    pDevInfo = NULL;
+    Status = pAcpiTkGetObjectInfoAlloc( ObjHandle, &pDevInfo );
+
+    if (Status == AE_OK)
+    {
+        if (pDevInfo->Type != ACPI_TYPE_DEVICE) return AE_DEPTH;
+        if (!(pDevInfo->Valid & ACPI_VALID_HID)) return AE_DEPTH;
+        if (!pDevInfo->HardwareId.String ) return AE_DEPTH;
+
+        if (strncmp(pDevInfo->HardwareId.String, "ACPI0003", 8)==0)
+        { /* AC Power */
+            Status = pAcpiTkGetHandle(ObjHandle, "_PSR", &G_ahAC);
+            if (Status) G_ahAC = 0;
+            return AE_DEPTH;
+        }
+
+        if (strncmp(pDevInfo->HardwareId.String, "PNP0C0A", 7)==0)
+        { /* Smart battery */
+            if (G_uiBatteryCount >= MAX_BATTERY_COUNT) return AE_DEPTH;
+            G_ahBat[G_uiBatteryCount] = ObjHandle;
+            G_uiBatteryCount++;
+            return AE_DEPTH;
+        }
+    }
+
+    if (pDevInfo) pAcpiTkOsFree(pDevInfo);
+
+    return AE_OK;
+}
+
+/**
+ *@@ acpihGetPowerStatus:
+ *      Returns power and battery status in caller provided buffers.
+ *      Returns zero if success, non-zero if fail.
+ *      Code provided by David Azarewicz
+ *@@added V1.0.9 (2012-02-20) [slevine]: code from David Azarewicz
+ */
+APIRET acpihGetPowerStatus(PAPM pApm, PBOOL pfChanged)
+{
+    ACPI_STATUS Status;
+    ACPI_BUFFER Result;
+    ACPI_OBJECT *Obj, Object[20];
+    UINT32 uiI;
+    ULONG ulTmp, BRemaining, LastFull;
+    BOOL fChanged;
+
+    if (pAcpiTkWalkNamespace==NULL) return 1;
+    if (pApm==NULL) return 1;
+
+    if (!G_uiAlreadyWalked)
+    {
+        Status = pAcpiTkWalkNamespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT, ACPI_UINT32_MAX, AcpiCallbackWidget, pApm, NULL);
+        G_uiAlreadyWalked = 1;
+    }
+
+    fChanged = FALSE;
+
+    // VAC 3.08 long long compatibility support
+#   ifdef INCL_LONGLONG // VAC 3.6.5 - compiler supports long long
+#   define OBJECT_VALUE(index)  (Object[index].Integer.Value)
+#   else // VAC 3.08 - compiler does not support long long
+#   define OBJECT_VALUE(index)  (Object[index].Integer.Value.ulLo)
+#   endif
+
+    if (G_ahAC)
+    {
+        Result.Length = sizeof(Object);
+        Result.Pointer = Object;
+        Status = pAcpiTkEvaluateObject(G_ahAC, NULL, NULL, &Result);
+        if (Status != AE_OK) ulTmp = 2;
+        if (Object[0].Type != ACPI_TYPE_INTEGER) ulTmp = 2;
+
+        ulTmp = OBJECT_VALUE(0);
+        if (pApm->fUsingAC != ulTmp)
+        {
+            pApm->fUsingAC = ulTmp;
+            fChanged = TRUE;
+        }
+    }
+
+    for (uiI=0; uiI<G_uiBatteryCount; uiI++)
+    {
+        if (G_ahBat[uiI] == 0) continue;
+
+        Result.Length = sizeof(Object);
+        Result.Pointer = Object;
+        Status = pAcpiTkEvaluateObject(G_ahBat[uiI], "_BIF", NULL, &Result);
+        if (Status != AE_OK)
+        {
+            G_ahBat[uiI] = 0;
+            continue;
+        }
+
+        Obj = Result.Pointer;
+        Obj = (ACPI_OBJECT *)Obj[0].Package.Elements;
+        LastFull = (UINT32)OBJECT_VALUE(2);
+        if (LastFull == 0xffffffff)
+        {
+            G_ahBat[uiI] = 0;
+            continue;
+        }
+
+        Result.Length = sizeof(Object);
+        Result.Pointer = Object;
+        Status = pAcpiTkEvaluateObject(G_ahBat[uiI], "_BST", NULL, &Result);
+        if (Status != AE_OK)
+        {
+            G_ahBat[uiI] = 0;
+            continue;
+        }
+
+        Obj = Result.Pointer;
+        Obj = (ACPI_OBJECT *)Obj[0].Package.Elements;
+
+        if (OBJECT_VALUE(2) != 0xffffffff)
+        {
+            BRemaining = (UINT32)OBJECT_VALUE(2);
+        }
+
+        if (OBJECT_VALUE(0) != 0xffffffff)
+        {
+            if (BRemaining > (LastFull >> 1)) // > 50% is high. < 50% is low
+            {
+                ulTmp = 1; // High
+            }
+            else
+            {
+                ulTmp = 2; // Low
+            }
+
+            if (OBJECT_VALUE(0) & 4)
+            {
+                ulTmp = 2; // Critical
+            }
+            // If battery charging - it can't be critical
+            if (OBJECT_VALUE(0) & 2)
+            {
+                ulTmp = 3; // Charging
+            }
+            if (pApm->bBatteryStatus != ulTmp)
+            {
+                pApm->bBatteryStatus = ulTmp;
+                fChanged = TRUE;
+            }
+        }
+
+        ulTmp = (BRemaining*100)/LastFull;
+        if (ulTmp > 100) ulTmp = 100;
+        if (pApm->bBatteryLife != ulTmp)
+        {
+            pApm->bBatteryLife = ulTmp;
+            fChanged = TRUE;
+        }
+    }
+
+    if (pfChanged) *pfChanged = fChanged;
+    pApm->fAlreadyRead = FALSE;
+
+    return 0;
+
+#   undef OBJECT_VALUE
+}
+
+/*
+ *@@ acpihHasBattery:
+ *      quick'n'dirty helper which returns TRUE only
+ *      if ACPI is supported on the system and the
+ *      system actually has a battery (i.e. is a laptop).
+ *      Code provided by David Azarewicz.
+ * @@added V1.0.9 (2012-02-20) [slevine]: code from David Azarewicz
+ */
+BOOL acpihHasBattery(VOID)
+{
+    BOOL brc = FALSE;
+    ACPI_API_HANDLE hACPI;
+    APM Apm;
+
+    if (!acpihOpen(&hACPI))
+    {
+        Apm.bBatteryStatus = 0xff;
+        if (!acpihGetPowerStatus(&Apm, NULL)) brc = (Apm.bBatteryStatus != 0xFF);
+        acpihClose(&hACPI);
+    }
+
+    return brc;
+}