// 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)) { strscpy(machine->id, comp_ids->codecs[i], ACPI_ID_LEN); 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_fetch_acpi_dev(handle); acpi_status status; struct snd_soc_acpi_package_context *pkg_ctx = context; pkg_ctx->data_valid = false; if (adev && 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); #define SDW_CODEC_ADR_MASK(_adr) ((_adr) & (SDW_DISCO_LINK_ID_MASK | SDW_VERSION_MASK | \ SDW_MFG_ID_MASK | SDW_PART_ID_MASK)) /* Check if all Slaves defined on the link can be found */ bool snd_soc_acpi_sdw_link_slaves_found(struct device *dev, const struct snd_soc_acpi_link_adr *link, struct sdw_extended_slave_id *ids, int num_slaves) { unsigned int part_id, link_id, unique_id, mfg_id, version; int i, j, k; for (i = 0; i < link->num_adr; i++) { u64 adr = link->adr_d[i].adr; int reported_part_count = 0; mfg_id = SDW_MFG_ID(adr); part_id = SDW_PART_ID(adr); link_id = SDW_DISCO_LINK_ID(adr); version = SDW_VERSION(adr); for (j = 0; j < num_slaves; j++) { /* find out how many identical parts were reported on that link */ if (ids[j].link_id == link_id && ids[j].id.part_id == part_id && ids[j].id.mfg_id == mfg_id && ids[j].id.sdw_version == version) reported_part_count++; } for (j = 0; j < num_slaves; j++) { int expected_part_count = 0; if (ids[j].link_id != link_id || ids[j].id.part_id != part_id || ids[j].id.mfg_id != mfg_id || ids[j].id.sdw_version != version) continue; /* find out how many identical parts are expected */ for (k = 0; k < link->num_adr; k++) { u64 adr2 = link->adr_d[k].adr; if (SDW_CODEC_ADR_MASK(adr2) == SDW_CODEC_ADR_MASK(adr)) expected_part_count++; } if (reported_part_count == expected_part_count) { /* * we have to check unique id * if there is more than one * Slave on the link */ unique_id = SDW_UNIQUE_ID(adr); if (reported_part_count == 1 || ids[j].id.unique_id == unique_id) { dev_dbg(dev, "found part_id %#x at link %d\n", part_id, link_id); break; } } else { dev_dbg(dev, "part_id %#x reported %d expected %d on link %d, skipping\n", part_id, reported_part_count, expected_part_count, link_id); } } if (j == num_slaves) { dev_dbg(dev, "Slave part_id %#x not found\n", part_id); return false; } } return true; } EXPORT_SYMBOL_GPL(snd_soc_acpi_sdw_link_slaves_found); MODULE_LICENSE("GPL v2"); MODULE_DESCRIPTION("ALSA SoC ACPI module");