sound/soc/intel/common/sst-match-acpi.c

   1 /*
   2  * sst_match_apci.c - SST (LPE) match for ACPI enumeration.
   3  *
   4  * Copyright (c) 2013-15, Intel Corporation.
   5  *
   6  *
   7  * This program is free software; you can redistribute it and/or modify it
   8  * under the terms and conditions of the GNU General Public License,
   9  * version 2, as published by the Free Software Foundation.
  10  *
  11  * This program is distributed in the hope it will be useful, but WITHOUT
  12  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  14  * more details.
  15  */
  16
  17 #include "sst-acpi.h"
  18
  19 static acpi_status sst_acpi_find_name(acpi_handle handle, u32 level,
  20                                       void *context, void **ret)
  21 {
  22         struct acpi_device *adev;
  23         const char *name = NULL;
  24
  25         if (acpi_bus_get_device(handle, &adev))
  26                 return AE_OK;
  27
  28         if (adev->status.present && adev->status.functional) {
  29                 name = acpi_dev_name(adev);
  30                 *(const char **)ret = name;
  31                 return AE_CTRL_TERMINATE;
  32         }
  33
  34         return AE_OK;
  35 }
  36
  37 const char *sst_acpi_find_name_from_hid(const u8 hid[ACPI_ID_LEN])
  38 {
  39         const char *name = NULL;
  40         acpi_status status;
  41
  42         status = acpi_get_devices(hid, sst_acpi_find_name, NULL,
  43                                   (void **)&name);
  44
  45         if (ACPI_FAILURE(status) || name[0] == '\0')
  46                 return NULL;
  47
  48         return name;
  49 }
  50 EXPORT_SYMBOL_GPL(sst_acpi_find_name_from_hid);
  51
  52 static acpi_status sst_acpi_mach_match(acpi_handle handle, u32 level,
  53                                        void *context, void **ret)
  54 {
  55         unsigned long long sta;
  56         acpi_status status;
  57
  58         *(bool *)context = true;
  59         status = acpi_evaluate_integer(handle, "_STA", NULL, &sta);
  60         if (ACPI_FAILURE(status) || !(sta & ACPI_STA_DEVICE_PRESENT))
  61                 *(bool *)context = false;
  62
  63         return AE_OK;
  64 }
  65
  66 bool sst_acpi_check_hid(const u8 hid[ACPI_ID_LEN])
  67 {
  68         acpi_status status;
  69         bool found = false;
  70
  71         status = acpi_get_devices(hid, sst_acpi_mach_match, &found, NULL);
  72
  73         if (ACPI_FAILURE(status))
  74                 return false;
  75
  76         return found;
  77 }
  78 EXPORT_SYMBOL_GPL(sst_acpi_check_hid);
  79
  80 struct sst_acpi_mach *sst_acpi_find_machine(struct sst_acpi_mach *machines)
  81 {
  82         struct sst_acpi_mach *mach;
  83
  84         for (mach = machines; mach->id[0]; mach++) {
  85                 if (sst_acpi_check_hid(mach->id) == true) {
  86                         if (mach->machine_quirk)
  87                                 mach = mach->machine_quirk(mach);
  88                         return mach;
  89                 }
  90         }
  91         return NULL;
  92 }
  93 EXPORT_SYMBOL_GPL(sst_acpi_find_machine);
  94
  95 static acpi_status sst_acpi_find_package(acpi_handle handle, u32 level,
  96                                         void *context, void **ret)
  97 {
  98         struct acpi_device *adev;
  99         acpi_status status = AE_OK;
 100         struct sst_acpi_package_context *pkg_ctx = context;
 101
 102         pkg_ctx->data_valid = false;
 103
 104         if (acpi_bus_get_device(handle, &adev))
 105                 return AE_OK;
 106
 107         if (adev->status.present && adev->status.functional) {
 108                 struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
 109                 union acpi_object  *myobj = NULL;
 110
 111                 status = acpi_evaluate_object_typed(handle, pkg_ctx->name,
 112                                                 NULL, &buffer,
 113                                                 ACPI_TYPE_PACKAGE);
 114                 if (ACPI_FAILURE(status))
 115                         return AE_OK;
 116
 117                 myobj = buffer.pointer;
 118                 if (!myobj || myobj->package.count != pkg_ctx->length) {
 119                         kfree(buffer.pointer);
 120                         return AE_OK;
 121                 }
 122
 123                 status = acpi_extract_package(myobj,
 124                                         pkg_ctx->format, pkg_ctx->state);
 125                 if (ACPI_FAILURE(status)) {
 126                         kfree(buffer.pointer);
 127                         return AE_OK;
 128                 }
 129
 130                 kfree(buffer.pointer);
 131                 pkg_ctx->data_valid = true;
 132                 return AE_CTRL_TERMINATE;
 133         }
 134
 135         return AE_OK;
 136 }
 137
 138 bool sst_acpi_find_package_from_hid(const u8 hid[ACPI_ID_LEN],
 139                                 struct sst_acpi_package_context *ctx)
 140 {
 141         acpi_status status;
 142
 143         status = acpi_get_devices(hid, sst_acpi_find_package, ctx, NULL);
 144
 145         if (ACPI_FAILURE(status) || !ctx->data_valid)
 146                 return false;
 147
 148         return true;
 149 }
 150 EXPORT_SYMBOL_GPL(sst_acpi_find_package_from_hid);
 151
 152 struct sst_acpi_mach *sst_acpi_codec_list(void *arg)
 153 {
 154         struct sst_acpi_mach *mach = arg;
 155         struct sst_codecs *codec_list = (struct sst_codecs *) mach->quirk_data;
 156         int i;
 157
 158         if (mach->quirk_data == NULL)
 159                 return mach;
 160
 161         for (i = 0; i < codec_list->num_codecs; i++) {
 162                 if (sst_acpi_check_hid(codec_list->codecs[i]) != true)
 163                         return NULL;
 164         }
 165
 166         return mach;
 167 }
 168 EXPORT_SYMBOL_GPL(sst_acpi_codec_list);
 169
 170 MODULE_LICENSE("GPL v2");
 171 MODULE_DESCRIPTION("Intel Common ACPI Match module");