rom/hidds/acpi/button/acpibutton_init.c

   1 /*
   2     Copyright (C) 2017, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #define DEBUG 1
   7 #include <aros/debug.h>
   8
   9 #include <stddef.h>
  10 #include <exec/types.h>
  11
  12 #include <proto/exec.h>
  13 #include <proto/oop.h>
  14
  15 #include <aros/symbolsets.h>
  16 #include <hidd/hidd.h>
  17 #include <hidd/system.h>
  18
  19 #include "acpibutton_intern.h"
  20
  21 #include LC_LIBDEFS_FILE
  22
  23 static ACPI_STATUS ACPIButton_DeviceQuery(ACPI_HANDLE handle,
  24                                 UINT32 level,
  25                                 void *context,
  26                                 void **retval)
  27 {
  28     struct class_static_data    *csd = (struct class_static_data *)context;
  29     ACPI_DEVICE_INFO            *acpiDevInfo = NULL;
  30     ACPI_STATUS                 acpiStatus;
  31
  32     D(bug("[HiddACPIButton] %s(0x%p)\n", __func__, handle));
  33
  34     acpiStatus = AcpiGetObjectInfo(handle, &acpiDevInfo);
  35     if (acpiStatus != AE_OK) {
  36         if (acpiDevInfo) {
  37             FreeVec(acpiDevInfo);
  38         }
  39         return acpiStatus;
  40     }
  41
  42     if (acpiDevInfo->Valid & ACPI_VALID_HID)
  43     {
  44         D(bug("[HiddACPIButton] %s: HardwareID = '%s'\n", __func__, acpiDevInfo->HardwareId.String));
  45
  46         if (!strcmp(acpiDevInfo->HardwareId.String, "PNP0C0C"))
  47         {
  48             D(bug("[HiddACPIButton] %s: Power Button Device Found\n", __func__));
  49             csd->acpiPowerBHandle = handle;
  50             csd->acpiPowerBType = vHidd_ACPIButton_Power;
  51         }
  52         else if (!strcmp(acpiDevInfo->HardwareId.String, "ACPI_FPB"))
  53         {
  54             D(bug("[HiddACPIButton] %s: Fixed Power Button Device Found\n", __func__));
  55             csd->acpiPowerBHandle = handle;
  56             csd->acpiPowerBType = vHidd_ACPIButton_PowerF;
  57         }
  58         else if (!strcmp(acpiDevInfo->HardwareId.String, "PNP0C0E"))
  59         {
  60             D(bug("[HiddACPIButton] %s: Sleep Button Device Found\n", __func__));
  61             csd->acpiSleepBHandle = handle;
  62             csd->acpiSleepBType = vHidd_ACPIButton_Sleep;
  63         }
  64         else if (!strcmp(acpiDevInfo->HardwareId.String, "ACPI_FSB"))
  65         {
  66             D(bug("[HiddACPIButton] %s: Fixed Sleep Button Device Found\n", __func__));
  67             csd->acpiSleepBHandle = handle;
  68             csd->acpiSleepBType = vHidd_ACPIButton_SleepF;
  69         }
  70         else if (!strcmp(acpiDevInfo->HardwareId.String, "PNP0C0D"))
  71         {
  72             D(bug("[HiddACPIButton] %s: Lid Button Device Found\n", __func__));
  73             csd->acpibLidBHandle = handle;
  74         }
  75     }
  76
  77     FreeVec(acpiDevInfo);
  78
  79     return AE_OK;
  80 }
  81
  82 static int ACPIButton_Init(LIBBASETYPEPTR LIBBASE)
  83 {
  84     struct class_static_data    *csd = &LIBBASE->hsi_csd;
  85     struct Library              *OOPBase = csd->cs_OOPBase;
  86     OOP_Object                  *root;
  87     int                         buttonCount = 0;
  88     int                         retVal = FALSE;
  89     __unused ACPI_STATUS        acpiStatus;
  90
  91     D(bug("[HiddACPIButton] %s()\n", __func__));
  92
  93     csd->cs_ACPICABase = OpenLibrary("acpica.library", 0);
  94     if (!csd->cs_ACPICABase)
  95         return FALSE;
  96
  97     csd->cs_UtilityBase = OpenLibrary("utility.library", 36);
  98     if (!csd->cs_UtilityBase)
  99     {
 100         CloseLibrary(csd->cs_ACPICABase);
 101         return FALSE;
 102     }
 103
 104     root = OOP_NewObject(NULL, CLID_Hidd_System, NULL);
 105     if (!root)
 106         root = OOP_NewObject(NULL, CLID_HW_Root, NULL);
 107
 108     csd->hwAB = OOP_ObtainAttrBase(IID_HW);
 109     csd->hiddAB = OOP_ObtainAttrBase(IID_Hidd);
 110     csd->hiddACPIButtonAB = OOP_ObtainAttrBase(IID_Hidd_ACPIButton);
 111
 112     {
 113         struct TagItem instanceTags[] =
 114         {
 115             { csd->hiddACPIButtonAB + aoHidd_ACPIButton_Type,   0},
 116             { csd->hiddACPIButtonAB + aoHidd_ACPIButton_Handle, 0},
 117             { csd->hiddACPIButtonAB + aoHidd_ACPIButton_Hook,   0},
 118             { TAG_DONE,                                         0}
 119         };
 120
 121         acpiStatus = AcpiGetDevices(NULL, ACPIButton_DeviceQuery, csd, NULL);
 122         if (acpiStatus == AE_OK)
 123         {
 124             if (csd->acpiPowerBHandle != NULL)
 125             {
 126                 instanceTags[0].ti_Data = (IPTR)csd->acpiPowerBType;
 127                 instanceTags[1].ti_Data = (IPTR)csd->acpiPowerBHandle;
 128                 instanceTags[2].ti_Data = 0;
 129
 130                 if (HW_AddDriver(root, csd->oopclass, instanceTags))
 131                 {
 132                     D(bug("[HiddACPIButton] %s: Power-Button initialised\n", __func__));
 133                     buttonCount++;
 134                 }
 135             }
 136
 137             if (csd->acpiSleepBHandle != NULL)
 138             {
 139                 instanceTags[0].ti_Data = (IPTR)csd->acpiSleepBType;
 140                 instanceTags[1].ti_Data = (IPTR)csd->acpiSleepBHandle;
 141                 instanceTags[2].ti_Data = 0;
 142
 143                 if (HW_AddDriver(root, csd->oopclass, instanceTags))
 144                 {
 145                     D(bug("[HiddACPIButton] %s: Sleep-Button initialised\n", __func__));
 146                     buttonCount++;
 147                 }
 148             }
 149
 150             if (csd->acpibLidBHandle != NULL)
 151             {
 152                 instanceTags[0].ti_Data = vHidd_ACPIButton_Lid;
 153                 instanceTags[1].ti_Data = (IPTR)csd->acpibLidBHandle;
 154                 instanceTags[2].ti_Data = 0;
 155
 156                 if (HW_AddDriver(root, csd->oopclass, instanceTags))
 157                 {
 158                     D(bug("[HiddACPIButton] %s: Lid-Button initialised\n", __func__));
 159                     buttonCount++;
 160                 }
 161             }
 162         }
 163     }
 164     D(bug("[HiddACPIButton] %s: Finished\n", __func__));
 165
 166     if (buttonCount > 0)
 167         retVal = TRUE;
 168
 169     return retVal;
 170 }
 171
 172 static int ACPIButton_Expunge(LIBBASETYPEPTR LIBBASE)
 173 {
 174     D(struct class_static_data *csd = &LIBBASE->hsi_csd;)
 175 #if (0)
 176     struct Library *OOPBase = csd->cs_OOPBase;
 177 #endif
 178     D(bug("[HiddACPIButton] %s(csd=%p)\n", __func__, csd));
 179
 180     return TRUE;
 181 }
 182
 183 ADD2INITLIB(ACPIButton_Init, -2)
 184 ADD2EXPUNGELIB(ACPIButton_Expunge, -2)