forked from Minki/linux
cafa39b650
A machine driver needs to be enumerated by more than one ACPI HID if it supports second headphone driver (i.e. rt5682 and rt5682s). However, the id field in snd_soc_acpi_mach structure could contain only one HID. By adding a 'comp_ids' field which can contain several HIDs, we can enumerate a machine driver by multiple ACPI HIDs. Signed-off-by: Brent Lu <brent.lu@intel.com> Link: https://lore.kernel.org/r/20211029171409.611600-2-brent.lu@intel.com Signed-off-by: Mark Brown <broonie@kernel.org>
131 lines
2.9 KiB
C
131 lines
2.9 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
//
|
|
// soc-apci.c - support for ACPI enumeration.
|
|
//
|
|
// Copyright (c) 2013-15, Intel Corporation.
|
|
|
|
#include <linux/export.h>
|
|
#include <linux/module.h>
|
|
#include <sound/soc-acpi.h>
|
|
|
|
static bool snd_soc_acpi_id_present(struct snd_soc_acpi_mach *machine)
|
|
{
|
|
const struct snd_soc_acpi_codecs *comp_ids = machine->comp_ids;
|
|
int i;
|
|
|
|
if (machine->id[0]) {
|
|
if (acpi_dev_present(machine->id, NULL, -1))
|
|
return true;
|
|
}
|
|
|
|
if (comp_ids) {
|
|
for (i = 0; i < comp_ids->num_codecs; i++) {
|
|
if (acpi_dev_present(comp_ids->codecs[i], NULL, -1))
|
|
return true;
|
|
}
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
struct snd_soc_acpi_mach *
|
|
snd_soc_acpi_find_machine(struct snd_soc_acpi_mach *machines)
|
|
{
|
|
struct snd_soc_acpi_mach *mach;
|
|
struct snd_soc_acpi_mach *mach_alt;
|
|
|
|
for (mach = machines; mach->id[0] || mach->comp_ids; mach++) {
|
|
if (snd_soc_acpi_id_present(mach)) {
|
|
if (mach->machine_quirk) {
|
|
mach_alt = mach->machine_quirk(mach);
|
|
if (!mach_alt)
|
|
continue; /* not full match, ignore */
|
|
mach = mach_alt;
|
|
}
|
|
|
|
return mach;
|
|
}
|
|
}
|
|
return NULL;
|
|
}
|
|
EXPORT_SYMBOL_GPL(snd_soc_acpi_find_machine);
|
|
|
|
static acpi_status snd_soc_acpi_find_package(acpi_handle handle, u32 level,
|
|
void *context, void **ret)
|
|
{
|
|
struct acpi_device *adev;
|
|
acpi_status status;
|
|
struct snd_soc_acpi_package_context *pkg_ctx = context;
|
|
|
|
pkg_ctx->data_valid = false;
|
|
|
|
if (acpi_bus_get_device(handle, &adev))
|
|
return AE_OK;
|
|
|
|
if (adev->status.present && adev->status.functional) {
|
|
struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
|
|
union acpi_object *myobj = NULL;
|
|
|
|
status = acpi_evaluate_object_typed(handle, pkg_ctx->name,
|
|
NULL, &buffer,
|
|
ACPI_TYPE_PACKAGE);
|
|
if (ACPI_FAILURE(status))
|
|
return AE_OK;
|
|
|
|
myobj = buffer.pointer;
|
|
if (!myobj || myobj->package.count != pkg_ctx->length) {
|
|
kfree(buffer.pointer);
|
|
return AE_OK;
|
|
}
|
|
|
|
status = acpi_extract_package(myobj,
|
|
pkg_ctx->format, pkg_ctx->state);
|
|
if (ACPI_FAILURE(status)) {
|
|
kfree(buffer.pointer);
|
|
return AE_OK;
|
|
}
|
|
|
|
kfree(buffer.pointer);
|
|
pkg_ctx->data_valid = true;
|
|
return AE_CTRL_TERMINATE;
|
|
}
|
|
|
|
return AE_OK;
|
|
}
|
|
|
|
bool snd_soc_acpi_find_package_from_hid(const u8 hid[ACPI_ID_LEN],
|
|
struct snd_soc_acpi_package_context *ctx)
|
|
{
|
|
acpi_status status;
|
|
|
|
status = acpi_get_devices(hid, snd_soc_acpi_find_package, ctx, NULL);
|
|
|
|
if (ACPI_FAILURE(status) || !ctx->data_valid)
|
|
return false;
|
|
|
|
return true;
|
|
}
|
|
EXPORT_SYMBOL_GPL(snd_soc_acpi_find_package_from_hid);
|
|
|
|
struct snd_soc_acpi_mach *snd_soc_acpi_codec_list(void *arg)
|
|
{
|
|
struct snd_soc_acpi_mach *mach = arg;
|
|
struct snd_soc_acpi_codecs *codec_list =
|
|
(struct snd_soc_acpi_codecs *) mach->quirk_data;
|
|
int i;
|
|
|
|
if (mach->quirk_data == NULL)
|
|
return mach;
|
|
|
|
for (i = 0; i < codec_list->num_codecs; i++) {
|
|
if (!acpi_dev_present(codec_list->codecs[i], NULL, -1))
|
|
return NULL;
|
|
}
|
|
|
|
return mach;
|
|
}
|
|
EXPORT_SYMBOL_GPL(snd_soc_acpi_codec_list);
|
|
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_DESCRIPTION("ALSA SoC ACPI module");
|